Diff: manualController.cc

Revision:

0:abed7d1e329c

diff -r 000000000000 -r abed7d1e329c manualController.cc
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/manualController.cc	Fri May 07 13:51:00 2021 +0000
@@ -0,0 +1,28 @@
+#include "manualController.h"
+
+ManualController::ManualController(PinName pinDistance, Serial* pc, SRF05* ranger, PwmOut* rangerServo, PwmOut* fan,PwmOut* fanServo, DigitalOut* greenLed, DigitalOut* redLed):
+        m_interruptDistance(pinDistance, PullDown), m_pc(pc), m_ranger(ranger), m_rangerServo(rangerServo), m_fan(fan), m_fanServo(fanServo),
+        m_greenLed(greenLed), m_redLed(redLed)
+{
+    m_interruptDistance.rise(this, &ManualController::hwInterruptReadDistance);
+}
+
+void ManualController::executeManualControll()
+{
+    AnalogIn servoRangerAIn(A1);
+    AnalogIn servoFanAIn(A2);
+    AnalogIn fanAIn(A3);
+    
+    while(1) {
+        m_rangerServo->pulsewidth_us(500+(2000*servoRangerAIn));
+        wait(0.15);
+        m_fanServo->pulsewidth_us(500+(2000*servoFanAIn));
+        wait(0.15);
+        m_fan->pulsewidth_us(20000*fanAIn);
+        wait(0.15);
+    }   
+}
+
+void ManualController::hwInterruptReadDistance() {
+    m_pc->printf("Distance: %f\r", m_ranger->read());
+}
\ No newline at end of file