Diff: main.cpp

Revision:

0:0b992ae0bfd9

diff -r 000000000000 -r 0b992ae0bfd9 main.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Tue Oct 31 14:24:40 2017 +0000
@@ -0,0 +1,99 @@
+#include "mbed.h"
+#include "Servo.h"
+#include "MODSERIAL.h"
+
+MODSERIAL pc(USBTX, USBRX);
+InterruptIn mbut(PTA4);
+InterruptIn sbut(PTC6);
+DigitalOut mode_signal(D2);
+DigitalOut led_rood(LED_RED);
+DigitalOut led_groen(LED_GREEN);
+DigitalOut led_blauw(LED_BLUE);
+
+int mode = 1;
+
+void mode_switcher() {
+           
+    switch(mode){
+        case 1: mode_signal = 1;
+                mode_signal = 0;
+                led_rood = 0;
+                led_groen = 1;
+                led_blauw = 1;
+                break;
+        case 2: mode_signal = 1;
+                mode_signal = 0;
+                led_rood = 1;
+                led_groen = 0;
+                led_blauw = 1;
+                break;
+        case 3: mode_signal = 1;
+                mode_signal = 0;
+                led_rood = 1;
+                led_groen = 1;
+                led_blauw = 0;
+                break;
+        case 4: mode_signal = 1;
+                mode_signal = 0;
+                led_rood = 0;
+                led_groen = 0;
+                led_blauw = 0;
+                break;
+        case 5: mode_signal = 1;
+                mode_signal = 0;
+                led_rood = 1;
+                led_groen = 0;
+                led_blauw = 0;
+                break;
+        case 6: mode_signal = 1;
+                mode_signal = 0;
+                led_rood = 0;
+                led_groen = 0;
+                led_blauw = 1;
+                break;
+        }
+    
+    pc.printf("The system is in mode %i\r\n", mode);
+    
+    mode += 1;
+    
+    if (mode==7) {
+        mode = 1;
+    }
+    
+}
+
+
+//------------------------------------------------------------------------------
+//--------------------------------Servo-----------------------------------------
+//------------------------------------------------------------------------------
+Servo MyServo(D9);
+InterruptIn But1(D8);
+int k=0;
+
+void servo_control (){
+    if (k==0){
+        MyServo = 0;
+        k=1;
+    }
+    else{
+        MyServo = 2;
+        k=0;
+        }
+}
+//------------------------------------------------------------------------------
+//------------------------------------------------------------------------------
+//------------------------------------------------------------------------------
+    
+
+
+int main()
+{
+    led_rood = 1;
+    led_groen = 1;
+    led_blauw = 1;
+    
+    pc.baud(115200);
+    mbut.rise(&mode_switcher);
+    sbut.rise(&servo_control);
+}
\ No newline at end of file