| 265,6 → 265,11 |
|---|
| #define ACC_CRTL1_YEN 0x02 |
| #define ACC_CRTL1_ZEN 0x04 |
| |
| #define ACC_CRTL2_FILTER8 0x00 |
| #define ACC_CRTL2_FILTER16 0x01 |
| #define ACC_CRTL2_FILTER32 0x02 |
| #define ACC_CRTL2_FILTER64 0x03 |
| |
| #define ACC_CTRL4_BDU 0x80 // Block data update, (0: continuos update; 1: output registers not updated between MSB and LSB reading) |
| #define ACC_CTRL4_BLE 0x40 // Big/little endian, (0: data LSB @ lower address; 1: data MSB @ lower address) |
| #define ACC_CTRL4_FS_2G 0x00 |
| 503,6 → 508,7 |
|---|
| DebugOut.Analog[16] = AccRawVector.X; |
| DebugOut.Analog[17] = AccRawVector.Y; |
| DebugOut.Analog[18] = AccRawVector.Z; |
| DebugOut.Analog[19] = (DebugOut.Analog[19] * 3 + AccRawVector.Z) / 4; |
| } |
| // rx data handler for reading magnetic sensor configuration |
| void NCMAG_UpdateMagConfig(u8* pRxBuffer, u8 RxBufferSize) |
| 709,13 → 715,14 |
|---|
| return(NCMAG_SetMagConfig()); |
| } |
| |
| |
| //---------------------------------------------------------------- |
| u8 NCMAG_Init_ACCSensor(void) |
| { |
| AccConfig.ctrl_1 = ACC_CRTL1_PM_NORMAL|ACC_CRTL1_DR_400HZ|ACC_CRTL1_XEN|ACC_CRTL1_YEN|ACC_CRTL1_ZEN; |
| AccConfig.ctrl_2 = 0x00; |
| AccConfig.ctrl_1 = ACC_CRTL1_PM_NORMAL|ACC_CRTL1_DR_50HZ|ACC_CRTL1_XEN|ACC_CRTL1_YEN|ACC_CRTL1_ZEN; |
| AccConfig.ctrl_2 = ACC_CRTL2_FILTER64; |
| AccConfig.ctrl_3 = 0x00; |
| AccConfig.ctrl_4 = ACC_CTRL4_BDU|ACC_CTRL4_FS_2G; |
| AccConfig.ctrl_4 = ACC_CTRL4_BDU|ACC_CTRL4_FS_8G; |
| AccConfig.ctrl_5 = ACC_CTRL5_STW_OFF; |
| return(NCMAG_SetAccConfig()); |
| } |