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)) |