Rev 586 | Rev 598 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 586 | Rev 588 | ||
|---|---|---|---|
| Line 559... | Line 559... | ||
| 559 | WPL_Answer.Index = WPL_Store.Index; // echo Index in cmd answer |
559 | WPL_Answer.Index = WPL_Store.Index; // echo Index in cmd answer |
| 560 | WPL_Answer.Status = PointList_WriteToFile(&WPL_Store); |
560 | WPL_Answer.Status = PointList_WriteToFile(&WPL_Store); |
| 561 | UART1_Request_WPLStore = TRUE; |
561 | UART1_Request_WPLStore = TRUE; |
| 562 | break; |
562 | break; |
| Line 563... | Line -... | ||
| 563 | - | ||
| 564 | 563 | ||
| 565 | case 'j':// Set/Get NC-Parameter |
564 | case 'j':// Set/Get NC-Parameter |
| 566 | switch(SerialMsg.pData[0]) |
565 | switch(SerialMsg.pData[0]) |
| 567 | { |
566 | { |
| 568 | case 0: // get |
567 | case 0: // get |
| Line 1042... | Line 1041... | ||
| 1042 | { |
1041 | { |
| 1043 | Data3D.StickNick = FC.StickNick; |
1042 | Data3D.StickNick = FC.StickNick; |
| 1044 | Data3D.StickRoll = FC.StickRoll; |
1043 | Data3D.StickRoll = FC.StickRoll; |
| 1045 | Data3D.StickYaw = FC.StickYaw; |
1044 | Data3D.StickYaw = FC.StickYaw; |
| 1046 | Data3D.StickGas = FC.StickGas; |
1045 | Data3D.StickGas = FC.StickGas; |
| - | 1046 | Data3D.AngleNick = FromFlightCtrl.AngleNick; // in 0.1 deg |
|
| - | 1047 | Data3D.AngleRoll = FromFlightCtrl.AngleRoll; // in 0.1 deg |
|
| - | 1048 | Data3D.Heading = FromFlightCtrl.GyroHeading; // in 0.1 deg |
|
| - | 1049 | Data3D.Altimeter = FC.Altimeter; // in 5cm -> 20 = 1m |
|
| 1047 | MKProtocol_CreateSerialFrame(&UART1_tx_buffer, 'C', NC_ADDRESS, 1,(u8 *)&Data3D, sizeof(Data3D)); |
1050 | MKProtocol_CreateSerialFrame(&UART1_tx_buffer, 'C', NC_ADDRESS, 1,(u8 *)&Data3D, sizeof(Data3D)); |
| 1048 | UART1_Data3D_Timer = SetDelay(UART1_Data3D_Interval); |
1051 | UART1_Data3D_Timer = SetDelay(UART1_Data3D_Interval); |
| 1049 | UART1_Request_Data3D = FALSE; |
1052 | UART1_Request_Data3D = FALSE; |
| 1050 | } |
1053 | } |
| 1051 | else if((((UART1_MotorData_Interval > 0) && CheckDelay(UART1_MotorData_Timer) ) || UART1_Request_MotorData) && (UART1_tx_buffer.Locked == FALSE)) |
1054 | else if((((UART1_MotorData_Interval > 0) && CheckDelay(UART1_MotorData_Timer) ) || UART1_Request_MotorData) && (UART1_tx_buffer.Locked == FALSE)) |