Rev 972 | Rev 974 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 972 | Rev 973 | ||
|---|---|---|---|
| Line 192... | Line 192... | ||
| 192 | void DeployRescue() |
192 | void DeployRescue() |
| 193 | { |
193 | { |
| 194 | #if 0 |
194 | #if 0 |
| 195 | /* Yaw or pitch are greater than 60 Deg abs */ |
195 | /* Yaw or pitch are greater than 60 Deg abs */ |
| 196 | if (((abs(status.iTheta10) > 600) || (abs(status.iPhi10) > 600)) && |
196 | if (((abs(status.iTheta10) > 600) || (abs(status.iPhi10) > 600)) && |
| 197 | ((abs(AverageRoll_X) > Threshhold) || |
197 | ((abs(AverageRoll) > Threshhold) || |
| 198 | (abs(AverageRoll_Y) > Threshhold) || |
198 | (abs(AverageNick) > Threshhold) || |
| 199 | (abs(AverageRoll_Z) > Threshhold) )) |
199 | (abs(AverageGier) > Threshhold) )) |
| 200 | { |
200 | { |
| 201 | MotorenEin = 0; |
201 | MotorenEin = 0; |
| 202 | Delay_ms(1000); |
202 | Delay_ms(1000); |
| 203 | ReleaseServo(); |
203 | ReleaseServo(); |
| 204 | } |
204 | } |