David Grayson / Mbed 2 deprecated DeadReckoning

David's dead reckoning code for the LVBots competition on March 6th. Uses the mbed LPC1768, DRV8835, QTR-3RC, and two DC motors with encoders.

Dependencies:   PololuEncoder Pacer mbed GeneralDebouncer

Diff: motors.cpp

Revision:
4:1b20a11765c8
Child:
5:01ad080dc4fa
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/motors.cpp	Thu Feb 20 22:59:28 2014 +0000
@@ -0,0 +1,20 @@
+#include <mbed.h>
+
+static PwmOut motor1Pwm(p26);
+DigitalOut motor1Dir(p25);
+
+static PwmOut motor2Pwm(p24);
+DigitalOut motor2Dir(p23);
+
+
+void motors_init()
+{
+    motor1Pwm.period_us(50);
+    motor2Pwm.period_us(50);
+}
+
+void motors_speed_set(int16_t motor1_speed, int16_t motor2_speed)
+{
+    motor1Pwm.pulsewidth_us(motor1_speed);
+    motor2Pwm.pulsewidth_us(motor2_speed);    
+}