| 3,7 → 3,12 |
|---|
| |
| void main() |
| { |
| signed int16 X,Y,Z; |
| int1 last; |
| unsigned int16 anemo_round=0; |
| unsigned int16 i; |
| |
| |
| //signed int16 X,Y,Z; |
| setup_adc_ports(NO_ANALOGS|VSS_VDD); |
| setup_adc(ADC_CLOCK_DIV_2); |
| setup_spi(SPI_SS_DISABLED); |
| 13,13 → 18,21 |
|---|
| setup_ccp1(CCP_OFF); |
| setup_comparator(NC_NC_NC_NC);// This device COMP currently not supported by the PICWizard |
| |
| set_mag(); |
| // Init the HMC5883L. Set Mode register for |
| // continuous measurements. |
| hmc5883l_write_reg(HMC5883L_CFG_A_REG, 0x18); // no average, maximal update range |
| hmc5883l_write_reg(HMC5883L_CFG_B_REG, 0xE0); // maximal range |
| hmc5883l_write_reg(HMC5883L_MODE_REG, 0x00); |
| |
| // Continuously read and display the x,y,z results. |
| // Wait at least 67 ms between reads, re the HMC5883L data sheet. |
| |
| |
| printf("Magnetometr: \r\n",); |
| printf("(c)mlab JACHO 2013: \r\n",); |
| printf("X, Y, Z \r\n",); |
| |
| while(true) |
| /* while(true) |
| { |
| X = mag_readX(); |
| Y = mag_readY(); |
| 28,4 → 41,29 |
|---|
| Delay_ms(50); |
| |
| } |
| */ |
| |
| while(TRUE) |
| { |
| |
| for( i=0;i<=1000;i++) |
| { |
| // delay_ms(); |
| hmc5883l_read_data(); |
| |
| if(compass.x < 0) |
| { |
| if(last == 1) anemo_round++; |
| last=0; |
| } |
| if(compass.x > 0) last=1; |
| } |
| |
| printf("%6Ld %6Ld %6Ld %6Ld \n\r", compass.x, compass.y, compass.z, anemo_round); |
| anemo_round=0; |
| } |
| |
| } |
| |
| |
| |