| | |
| | | MA_SendRtkBrief(&brief); |
| | | UpdateRTKInfo(rtk); |
| | | } |
| | | if (events & MCU_UPDATE_EVT) { |
| | | DEBUG("MCU_UPDATE_EVT length %d", length); |
| | | // 0-31 version |
| | | // 32-33 selftest |
| | | // 34-35 gpio |
| | | // 36-37 speed |
| | | // 38-39 engine |
| | | // 40-55 sn |
| | | struct mcuBrief brief; |
| | | |
| | | memset(&brief, 0, sizeof(brief)); |
| | | |
| | | int x = 0; |
| | | while(data[x] != 0 && x < 32) x++; |
| | | |
| | | ConvertHex2String(brief.version, data, x); |
| | | brief.selftest = BUILD_UINT16(data[33], data[32]); |
| | | brief.gpio = BUILD_UINT16(data[35], data[34]); |
| | | brief.speed = BUILD_UINT16(data[37], data[36]); |
| | | brief.engine = BUILD_UINT16(data[39], data[38]); |
| | | memcpy(brief.sn, data+40, 16); |
| | | |
| | | MA_SendMcuBrief(&brief); |
| | | } |
| | | } |
| | | |
| | | static void *PlatformDataListenThread(void *p) { |