Steven Swenson
Small class to control a stepper motor
Diff: Motor.cpp
- Revision:
- 0:278f07b2be46
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/Motor.cpp Sun Nov 25 23:10:31 2012 +0000
@@ -0,0 +1,19 @@
+#include "Motor.h"
+
+Motor::Motor(PinName enable,PinName direction,PinName step) : _enable(enable), _direction(direction), _step(step) {
+_enable=1;
+}
+
+Motor::~Motor() {
+}
+
+void Motor::motor_turn(int direction, int steps) {
+ _enable=0;
+ float freq=600;//frequency of PWM signal to drive stepper motor
+ _step.period(1/freq);
+ _step.write(.5);
+ _direction=direction;
+ wait(steps*(1/freq));
+ _step.write(0);
+ _enable=1;
+}
\ No newline at end of file