Subversion Repositories FlightCtrl

Rev

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

Rev 1862 Rev 1865
Line 123... Line 123...
123
                if (rxdata == rxchksum)
123
                if (rxdata == rxchksum)
124
                        {
124
                        {
125
                  unsigned char *ptr = (unsigned char *)&FromNaviCtrl;
125
                  unsigned char *ptr = (unsigned char *)&FromNaviCtrl;
126
                          memcpy(ptr, (unsigned char *) SPI_Buffer,  sizeof(SPI_Buffer));
126
                          memcpy(ptr, (unsigned char *) SPI_Buffer,  sizeof(SPI_Buffer));
127
                          SPI_RxDataValid = 1;
127
                          SPI_RxDataValid = 1;
128
//                        DebugOut.Analog[26]--;
-
 
129
                        }
128
                        }
130
                        else
129
                        else
131
                         {
130
                         {
132
                          SPI_RxDataValid = 0;
131
                          SPI_RxDataValid = 0;
133
//                        DebugOut.Analog[26]++;
-
 
134
                         }
132
                         }
Line 135... Line 133...
135
 
133
 
136
 
134
 
Line 193... Line 191...
193
     case SPI_FCCMD_ACCU:
191
     case SPI_FCCMD_ACCU:
194
                        ToNaviCtrl.Param.Int[0] = Capacity.ActualCurrent; // 0.1A
192
                        ToNaviCtrl.Param.Int[0] = Capacity.ActualCurrent; // 0.1A
195
                        ToNaviCtrl.Param.Int[1] = Capacity.UsedCapacity; // mAh
193
                        ToNaviCtrl.Param.Int[1] = Capacity.UsedCapacity; // mAh
196
                        ToNaviCtrl.Param.Byte[4] = (unsigned char) UBat; // 0.1V
194
                        ToNaviCtrl.Param.Byte[4] = (unsigned char) UBat; // 0.1V
197
                        ToNaviCtrl.Param.Byte[5] = (unsigned char) BattLowVoltageWarning; //0.1V
195
                        ToNaviCtrl.Param.Byte[5] = (unsigned char) BattLowVoltageWarning; //0.1V
-
 
196
                                ToNaviCtrl.Param.Byte[6] = VarioCharacter;
198
        break;
197
        break;
Line 199... Line 198...
199
 
198
 
200
         case SPI_FCCMD_PARAMETER1:
199
         case SPI_FCCMD_PARAMETER1:
201
                                ToNaviCtrl.Param.Byte[0] = EE_Parameter.NaviGpsModeControl;     // Parameters for the Naviboard
200
                                ToNaviCtrl.Param.Byte[0] = EE_Parameter.NaviGpsModeControl;     // Parameters for the Naviboard
Line 330... Line 329...
330
                        GPSInfo.HomeDistance = FromNaviCtrl.Param.Int[2];
329
                        GPSInfo.HomeDistance = FromNaviCtrl.Param.Int[2];
331
                        GPSInfo.HomeBearing = FromNaviCtrl.Param.sInt[3];
330
                        GPSInfo.HomeBearing = FromNaviCtrl.Param.sInt[3];
332
                        PPM_in[25] = (signed char) FromNaviCtrl.Param.Byte[8]; // WP_EVENT-Channel-Value
331
                        PPM_in[25] = (signed char) FromNaviCtrl.Param.Byte[8]; // WP_EVENT-Channel-Value
333
            FromNC_AltitudeSpeed = FromNaviCtrl.Param.Byte[9];
332
            FromNC_AltitudeSpeed = FromNaviCtrl.Param.Byte[9];
334
                FromNC_AltitudeSetpoint = (long) FromNaviCtrl.Param.sInt[5] * 10;  // in cm
333
                FromNC_AltitudeSetpoint = (long) FromNaviCtrl.Param.sInt[5] * 10;  // in cm
335
DebugOut.Analog[24] = SollHoehe/5;
334
DebugOut.Analog[25] = FromNC_AltitudeSpeed;
336
                        break;
335
                        break;
337
// 0 = 0,1
336
// 0 = 0,1
338
// 1 = 2,3
337
// 1 = 2,3
339
// 2 = 4,5
338
// 2 = 4,5
340
// 3 = 6,7
339
// 3 = 6,7