Rev 972 | Rev 974 | Go to most recent revision | Show entire file | Regard 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 | } |