Rev 21 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 21 | Rev 32 | ||
|---|---|---|---|
| Line 56... | Line 56... | ||
| 56 | 56 | ||
| 57 | //D-Regler |
57 | //D-Regler |
| 58 | zwn2= gps_d*actualPos.velNorth; |
58 | zwn2= gps_d*actualPos.velNorth; |
| Line 59... | Line 59... | ||
| 59 | zwe2= gps_d*actualPos.velEast; |
59 | zwe2= gps_d*actualPos.velEast; |
| 60 | 60 | ||
| Line 61... | Line 61... | ||
| 61 | GPS_Nick = -1*(zwn+zwn1-zwn2) / skal; |
61 | GPS_Nick = (-zwn+zwn1-zwn2) / skal; |
| 62 | GPS_Roll = (zwe+zwe1-zwe2) / skal; |
62 | GPS_Roll = (zwe+zwe1-zwe2) / skal; |
| 63 | 63 | ||