Rev 1840 | Rev 1855 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 1840 | Rev 1848 | ||
|---|---|---|---|
| Line 198... | Line 198... | ||
| 198 | sinus = sintab[EE_Parameter.CamOrientation]; |
198 | sinus = sintab[EE_Parameter.CamOrientation]; |
| Line 199... | Line 199... | ||
| 199 | 199 | ||
| 200 | if(CalculateServoSignals == 1) |
200 | if(CalculateServoSignals == 1) |
| 201 | { |
201 | { |
| 202 | nick = (cosinus * IntegralNick) / 128L - (sinus * IntegralRoll) / 128L; |
- | |
| 203 | - | ||
| 204 | //POI_KameraNick = 450; |
202 | nick = (cosinus * IntegralNick) / 128L - (sinus * IntegralRoll) / 128L; |
| - | 203 | nick -= POI_KameraNick * 7; |
|
| 205 | nick -= POI_KameraNick * 7; |
204 | |
| Line 206... | Line 205... | ||
| 206 | DebugOut.Analog[16] = POI_KameraNick; |
205 | DebugOut.Analog[16] = POI_KameraNick; |
| 207 | 206 | ||
| 208 | nick = ((long)EE_Parameter.ServoNickComp * nick) / 512L; |
207 | nick = ((long)EE_Parameter.ServoNickComp * nick) / 512L; |