Robotics Interest Club / Mbed 2 deprecated Open_House_IR_Bluetooth

Dependencies:   Sabertooth mbed

Revision:
0:7a43aff338da
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/peixing.h	Fri Nov 06 12:47:28 2015 +0000
@@ -0,0 +1,60 @@
+#include "Sabertooth.h"
+
+Sabertooth front_sb(p9, 128, 2400);
+Sabertooth back_sb(p13, 129, 9600);
+
+void forward()
+{
+    front_sb.SetSpeedMotorA(40);
+    front_sb.SetSpeedMotorB(50);
+    back_sb.SetSpeedMotorA(50);
+    back_sb.SetSpeedMotorB(50);
+}
+
+void backward()
+{
+    front_sb.SetSpeedMotorA(-40);
+    front_sb.SetSpeedMotorB(-50);
+    back_sb.SetSpeedMotorA(-50);
+    back_sb.SetSpeedMotorB(-50);
+}
+
+void right()
+{
+    front_sb.SetSpeedMotorA(-40);
+    front_sb.SetSpeedMotorB(50);
+    back_sb.SetSpeedMotorA(-50);    
+    back_sb.SetSpeedMotorB(50);
+}
+
+void left()
+{
+    front_sb.SetSpeedMotorA(40);
+    front_sb.SetSpeedMotorB(-50);
+    back_sb.SetSpeedMotorA(50);
+    back_sb.SetSpeedMotorB(-50);
+}
+
+void turnright()
+{
+    front_sb.SetSpeedMotorA(-40);
+    front_sb.SetSpeedMotorB(50);
+    back_sb.SetSpeedMotorA(50);
+    back_sb.SetSpeedMotorB(-50);
+}
+
+void turnleft()
+{
+    front_sb.SetSpeedMotorA(40);
+    front_sb.SetSpeedMotorB(-50);
+    back_sb.SetSpeedMotorA(-50);
+    back_sb.SetSpeedMotorB(50);
+}
+
+void stop()
+{
+    front_sb.SetSpeedMotorA(0);
+    front_sb.SetSpeedMotorB(0);
+    back_sb.SetSpeedMotorA(0);
+    back_sb.SetSpeedMotorB(0);
+}
\ No newline at end of file