Subversion Repositories NaviCtrl

Rev

Rev 62 | Rev 72 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 62 Rev 64
Line 362... Line 362...
362
                                {       // put only new CompassCalState into queue to send via I2C
362
                                {       // put only new CompassCalState into queue to send via I2C
363
                                        CompassCalState = FromFlightCtrl.Param.Byte[0];
363
                                        CompassCalState = FromFlightCtrl.Param.Byte[0];
364
                                        fifo_put(&CompassCalcStateFiFo, CompassCalState);
364
                                        fifo_put(&CompassCalcStateFiFo, CompassCalState);
365
                                }
365
                                }
366
                                Parameter.NaviPH_LoginTime = FromFlightCtrl.Param.Byte[1];
366
                                Parameter.NaviPH_LoginTime = FromFlightCtrl.Param.Byte[1];
-
 
367
                NaviData.Variometer = (NaviData.Variometer + 2 * ((s16) FromFlightCtrl.Param.Int[1] - NaviData.Altimeter)) / 2; // provisorisch
367
                                NaviData.Altimeter = (s16) FromFlightCtrl.Param.Int[1]; // is located at byte 2 and 3
368
                                NaviData.Altimeter = (s16) FromFlightCtrl.Param.Int[1]; // is located at byte 2 and 3
368
                        CHK_POTI_MM(Parameter.NaviGpsPLimit,FromFlightCtrl.Param.Byte[4],0,255);
369
                        CHK_POTI_MM(Parameter.NaviGpsPLimit,FromFlightCtrl.Param.Byte[4],0,255);
369
                        CHK_POTI_MM(Parameter.NaviGpsILimit,FromFlightCtrl.Param.Byte[5],0,255);
370
                        CHK_POTI_MM(Parameter.NaviGpsILimit,FromFlightCtrl.Param.Byte[5],0,255);
370
                        CHK_POTI_MM(Parameter.NaviGpsDLimit,FromFlightCtrl.Param.Byte[6],0,255);
371
                        CHK_POTI_MM(Parameter.NaviGpsDLimit,FromFlightCtrl.Param.Byte[6],0,255);
371
                                break;
372
                                break;