a

Dependencies:   mbed

Revision:
0:f0b20f502059
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/RCInputProc/RCInputProc.cpp	Thu May 24 10:19:44 2018 +0000
@@ -0,0 +1,19 @@
+#include "mbed.h"
+#include "Global_Variables.h"
+#include "Pin_Assign.h"
+#include "PPMIn.h"
+#include "PPMOut.h"
+
+void RCInputProc(void)
+{
+    
+    YawPPM = ppmin.channels[5];
+    PitchPPM = ppmin.channels[6];
+    LockPPM = ppmin.channels[7];
+    
+    if(LockPPM>=IdlePWM&&LockPPM<=3000)    fLock =1;
+    else fLock =0;
+    
+    YawDegCMD       = 0.15f*(float)YawPPM-225.0f;
+    PitchDegCMD     = 0.15f*(float)PitchPPM-225.0f;
+}
\ No newline at end of file