Subversion Repositories NaviCtrl

Rev

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

Rev 300 Rev 306
Line 342... Line 342...
342
                                ToFlightCtrl.Param.Byte[1] = GPSData.NumOfSats;
342
                                ToFlightCtrl.Param.Byte[1] = GPSData.NumOfSats;
343
                                ToFlightCtrl.Param.Byte[2] = GPSData.SatFix;
343
                                ToFlightCtrl.Param.Byte[2] = GPSData.SatFix;
344
                                ToFlightCtrl.Param.Byte[3] = GPSData.Speed_Ground / 100; // m/s
344
                                ToFlightCtrl.Param.Byte[3] = GPSData.Speed_Ground / 100; // m/s
345
                                ToFlightCtrl.Param.Int[2]  = NaviData.HomePositionDeviation.Distance; // dm   //4&5
345
                                ToFlightCtrl.Param.Int[2]  = NaviData.HomePositionDeviation.Distance; // dm   //4&5
346
                                ToFlightCtrl.Param.sInt[3] = NaviData.HomePositionDeviation.Bearing;  // deg  //6&7
346
                                ToFlightCtrl.Param.sInt[3] = NaviData.HomePositionDeviation.Bearing;  // deg  //6&7
-
 
347
                                if(FC_WP_EventChannel > 254) FC_WP_EventChannel = 254;
347
                                ToFlightCtrl.Param.Byte[8] = (s8)(FC_WP_EventChannel - 110);
348
                                ToFlightCtrl.Param.Byte[8] = (s8)(FC_WP_EventChannel - 127);
348
 
-
 
349
                                if(NCRARAM_STATE_VALID == NCParams_GetValue(NCPARAMS_ALTITUDE_RATE, &tmp))
349
                                if(NCRARAM_STATE_VALID == NCParams_GetValue(NCPARAMS_ALTITUDE_RATE, &tmp))
350
                                {
350
                                {
351
                                        ToFlightCtrl.Param.Byte[9] = (u8)tmp;
351
                                        ToFlightCtrl.Param.Byte[9] = (u8)tmp;
352
                                }
352
                                }
353
                                else
353
                                else