Advertisement
Guest User

Untitled

a guest
Nov 22nd, 2014
139
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.64 KB | None | 0 0
  1. @name BlueFalconFloatKE
  2. @inputs POWER KEYBOARD KBINUSE HEIGHTA HEIGHTB HEIGHTC HEIGHTD HEIGHTAVRG P R DP DR DHEIGHTA DHEIGHTB DHEIGHTC DHEIGHTD DHEIGHTAVRG
  3. @outputs THROTTLE1 THROTTLE2 THROTTLE3 THROTTLE4
  4. @persist
  5. @trigger
  6.  
  7. A = P + DP #[Pitch + DeltaPitch = Thrust needed for stabilization]#
  8. B = -A
  9. C = R + DR
  10. D = -C
  11.  
  12. HEIGHT = 40
  13.  
  14. if (POWER == 1) {
  15. if ((HEIGHTA + HEIGHTAVRG) / 2 <= HEIGHT) {THROTTLEA = 20 + (A * 5) - (DHEIGHTA * 5)} elseif ((HEIGHTA + HEIGHTAVRG) / 2 > HEIGHT + 60) {THROTTLEA = A} else {THROTTLEA = 8 + (A * 2) - (DHEIGHTA * 5)}
  16. if ((HEIGHTB + HEIGHTAVRG) / 2 <= HEIGHT) {THROTTLEB = 20 + (B * 5) - (DHEIGHTB * 5)} elseif ((HEIGHTB + HEIGHTAVRG) / 2 > HEIGHT + 60) {THROTTLEB = B} else {THROTTLEB = 8 + (B * 2) - (DHEIGHTB * 5)}
  17. if ((HEIGHTC + HEIGHTAVRG) / 2 <= HEIGHT) {THROTTLEC = 20 + (C * 5) - (DHEIGHTC * 5)} elseif ((HEIGHTC + HEIGHTAVRG) / 2 > HEIGHT + 60) {THROTTLEC = C} else {THROTTLEC = 8 + (C * 2) - (DHEIGHTC * 5)}
  18. if ((HEIGHTD + HEIGHTAVRG) / 2 <= HEIGHT) {THROTTLED = 20 + (D * 5) - (DHEIGHTD * 5)} elseif ((HEIGHTD + HEIGHTAVRG) / 2 > HEIGHT + 60) {THROTTLED = D} else {THROTTLED = 8 + (D * 2) - (DHEIGHTD * 5)}
  19.  
  20. if (HEIGHTA <= 0 && DHEIGHTA < 0) {THROTTLE1 = 0 + (A * 5)} else {THROTTLE1 = THROTTLEA}
  21. if (HEIGHTB <= 0 && DHEIGHTB < 0) {THROTTLE2 = 0 + (B * 5)} else {THROTTLE2 = THROTTLEB}
  22. if (HEIGHTC <= 0 && DHEIGHTC < 0) {THROTTLE3 = 0 + (C * 5)} else {THROTTLE3 = THROTTLEC}
  23. if (HEIGHTD <= 0 && DHEIGHTD < 0) {THROTTLE4 = 0 + (D * 5)} else {THROTTLE4 = THROTTLED}
  24. } else {
  25. THROTTLE1 = 0
  26. THROTTLE2 = 0
  27. THROTTLE3 = 0
  28. THROTTLE4 = 0
  29. }
  30. #[(c)Devin & Alexander]#
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement