2015_robocon_bteam / Mbed 2 deprecated 2015robot_main

Dependencies:   PID QEI mbed

Fork of 2015robot_main by Naoto Deguchi

Revision:
32:eb7c263cb5cf
Parent:
29:03bb1ddbe456
--- a/machine_ps3.h	Sat Sep 19 10:57:41 2015 +0000
+++ b/machine_ps3.h	Sun Sep 20 04:31:34 2015 +0000
@@ -15,6 +15,8 @@
  * Includes
  */
 #include "mbed.h"
+#include <stdlib.h>
+#include <string.h>
 #include "QEI.h"
 #include "PID.h"
 #include "PinDefined_and_Setting_ps3.h"
@@ -39,6 +41,8 @@
 //Right
 void Move_r(float speed1)
 {
+    if(speed1>1.0) speed1=1.0;
+    else if(speed1<-1.0) speed1=-1.0;
     if(speed1<0) {
         Move_r_Motor_CCW    = 1;
         Move_r_Motor_CW     = 0;
@@ -52,6 +56,8 @@
 //Left
 void Move_l(float speed2)
 {
+    if(speed2>1.0) speed2=1.0;
+    else if(speed2<-1.0) speed2=-1.0;
     if(speed2<0) {
         Move_l_Motor_CCW    = 1;
         Move_l_Motor_CW     = 0;