Subversion Repositories FlightCtrl

Rev

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

Rev 2086 Rev 2087
Line 275... Line 275...
275
          navi_testOscPrescaler = 0;
275
          navi_testOscPrescaler = 0;
276
          navi_testOscTimer++;
276
          navi_testOscTimer++;
277
          if (navi_testOscTimer == staticParams.naviTestOscPeriod) {
277
          if (navi_testOscTimer == staticParams.naviTestOscPeriod) {
278
                  navi_testOscTimer = 0;
278
                  navi_testOscTimer = 0;
279
                  if (staticParams.naviTestOscAmplitude) {
279
                  if (staticParams.naviTestOscAmplitude) {
280
                          holdPosition->status = NEWDATA;
280
                          holdPosition.status = NEWDATA;
281
                          holdPosition->latitude += staticParams.naviTestOscAmplitude * 90L;
281
                          holdPosition.latitude += staticParams.naviTestOscAmplitude * 90L;
282
                  }
282
                  }
283
          } else if (navitestOscTimer == staticParams.naviTestOscPeriod/2) {
283
          } else if (navi_testOscTimer == staticParams.naviTestOscPeriod/2) {
284
                  if (staticParams.naviTestOscAmplitude) {
284
                  if (staticParams.naviTestOscAmplitude) {
285
                          holdPosition->status = NEWDATA;
285
                          holdPosition.status = NEWDATA;
286
                          holdPosition->latitude -= staticParams.naviTestOscAmplitude * 90L;
286
                          holdPosition.latitude -= staticParams.naviTestOscAmplitude * 90L;
287
                  }
287
                  }
288
          }
288
          }
289
  }
289
  }
Line 290... Line 290...
290
 
290