Subversion Repositories NaviCtrl

Rev

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

Rev 278 Rev 279
Line 294... Line 294...
294 
                                ToFlightCtrl.Param.sByte[2] = (s8) Kalman_MaxDrift;
 294 
                                ToFlightCtrl.Param.sByte[2] = (s8) Kalman_MaxDrift;
295 
                                ToFlightCtrl.Param.Byte[3]      = (u8) SerialLinkOkay;
 295 
                                ToFlightCtrl.Param.Byte[3]      = (u8) SerialLinkOkay;
296 
                                ToFlightCtrl.Param.sByte[4] = (s8) ToFcGpsZ;
 296 
                                ToFlightCtrl.Param.sByte[4] = (s8) ToFcGpsZ;
297 
                                ToFlightCtrl.Param.Byte[5] = (s8) ToFC_Rotate_C;
 297 
                                ToFlightCtrl.Param.Byte[5] = (s8) ToFC_Rotate_C;
298 
                                ToFlightCtrl.Param.Byte[6] = (s8) ToFC_Rotate_S;
 298 
                                ToFlightCtrl.Param.Byte[6] = (s8) ToFC_Rotate_S;
- 
 
 299 
                                ToFlightCtrl.Param.sInt[5] = CAM_Orientation.Elevation;
299 
                                if(CAM_Orientation.State == NEWDATA)
 300 
                                if(CAM_Orientation.State == NEWDATA)
300 
                                {
 301 
                                {
301 
                                        ToFlightCtrl.Param.sInt[4] = CAM_Orientation.Azimuth;
 302 
                                        ToFlightCtrl.Param.sInt[4] = CAM_Orientation.Azimuth;
302 
                                        ToFlightCtrl.Param.sInt[5] = CAM_Orientation.Elevation;
 - 
 
303 
                                        CAM_Orientation.State = PROCESSED;
 303 
                                        CAM_Orientation.State = PROCESSED;
304 
                                }
 304 
                                }
305 
                                else
 305 
                                else
306 
                                {       // set invalid values
 306 
                                {       // set invalid values
307 
                                        ToFlightCtrl.Param.sInt[4] = -1;
 307 
                                        ToFlightCtrl.Param.sInt[4] = -1;
308 
                                        ToFlightCtrl.Param.sInt[5] = -1;
 - 
 
309 
                                }
 308 
                                }
- 
 
 309 
DebugOut.Analog[24] = ToFlightCtrl.Param.sInt[5];
310 
                                break;
 310 
                                break;
Line 311... Line 311...
311 
 
 311 
 
312 
                        case SPI_NCCMD_VERSION:
 312 
                        case SPI_NCCMD_VERSION:
313 
                                ToFlightCtrl.Param.Byte[0] = VERSION_MAJOR;
 313 
                                ToFlightCtrl.Param.Byte[0] = VERSION_MAJOR;