unkounko

Dependencies:   mbed Servo

Revision:
1:e73cf2469f83
Parent:
0:562021ed1ba9
Child:
2:db575b3b2171
--- a/System/Process/Process.cpp	Sat Jan 13 13:33:09 2018 +0000
+++ b/System/Process/Process.cpp	Tue Jan 16 08:47:01 2018 +0000
@@ -90,17 +90,42 @@
 /------------------------ HOW TO WRITE ------------------------*/
 //↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓↓
 
+        if(controller->Button.X)        motor[0].dir = FOR;
+        else if(controller->Button.B)   motor[0].dir = BACK;
+        else                            motor[0].dir = FREE;
 
-
+        if(controller->Button.A)        motor[1].dir = FOR;
+        else if(controller->Button.Y)   motor[1].dir = BACK;
+        else                            motor[1].dir = FREE;
 
+        if(controller->Button.UP)        motor[2].dir = FOR;
+        else if(controller->Button.DOWN) motor[2].dir = BACK;
+        else                             motor[2].dir = FREE;
 
-
+        if(controller->Button.RIGHT)     motor[3].dir = FOR;
+        else if(controller->Button.LEFT) motor[3].dir = BACK;
+        else                             motor[3].dir = FREE;
 
+        if(controller->Button.R)        motor[4].dir = FOR;
+        else if(controller->Button.L)   motor[4].dir = BACK;
+        else                            motor[4].dir = FREE;
 
-
+        motor[0].pwm = 20;
+        motor[1].pwm = 20;
+        motor[2].pwm = 20;
+        motor[3].pwm = 20;
+        motor[4].pwm = 20;
 
+        if(controller->Button.ZL)       motor[0].pwm = 100;
+        if(controller->Button.ZR)       motor[1].pwm = 100;
+        if(controller->Button.SELECT)   motor[2].pwm = 100;
+        if(controller->Button.HOME)     motor[3].pwm = 100;
+        if(controller->Button.START)    motor[4].pwm = 100;
 
-
+        if(Switch::checkPushed(limitSw[0])) motor[0].pwm = 0;
+        if(Switch::checkPushed(limitSw[1])) motor[1].pwm = 0;
+        if(Switch::checkPushed(limitSw[2])) motor[2].pwm = 0;
+        if(Switch::checkPushed(limitSw[3])) motor[3].pwm = 0;
 
 
 //↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑↑