hezhian hezhain / armtest

Fork of stepper by Xiaoyuan Yu

Committer:
Dennis_Yu
Date:
Wed Jul 25 07:51:33 2018 +0000
Revision:
1:bbb51c42e7d2
Parent:
0:0774a793a83b
Child:
2:e537d08c705b
add funcs

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Dennis_Yu 1:bbb51c42e7d2 1 #include "mbed.h"
Dennis_Yu 1:bbb51c42e7d2 2 #include "stepper.h"
Dennis_Yu 1:bbb51c42e7d2 3
Dennis_Yu 1:bbb51c42e7d2 4 void stepperMotor::init()
Dennis_Yu 1:bbb51c42e7d2 5 {
Dennis_Yu 1:bbb51c42e7d2 6 remain = 0;
Dennis_Yu 1:bbb51c42e7d2 7 en = 0;
Dennis_Yu 1:bbb51c42e7d2 8 dir = 0;
Dennis_Yu 1:bbb51c42e7d2 9
Dennis_Yu 1:bbb51c42e7d2 10 }
Dennis_Yu 1:bbb51c42e7d2 11
Dennis_Yu 1:bbb51c42e7d2 12 void stepper::moveStepper()
Dennis_Yu 1:bbb51c42e7d2 13 {
Dennis_Yu 1:bbb51c42e7d2 14 if(remain == 0)
Dennis_Yu 1:bbb51c42e7d2 15 return;
Dennis_Yu 1:bbb51c42e7d2 16 if(step)
Dennis_Yu 1:bbb51c42e7d2 17 {
Dennis_Yu 1:bbb51c42e7d2 18 step = 0; //STEP 1->0
Dennis_Yu 1:bbb51c42e7d2 19 remain--;
Dennis_Yu 1:bbb51c42e7d2 20 }
Dennis_Yu 1:bbb51c42e7d2 21 else
Dennis_Yu 1:bbb51c42e7d2 22 {
Dennis_Yu 1:bbb51c42e7d2 23 step = 1; //STEP 0->1
Dennis_Yu 1:bbb51c42e7d2 24 }
Dennis_Yu 1:bbb51c42e7d2 25 }
Dennis_Yu 1:bbb51c42e7d2 26
Dennis_Yu 1:bbb51c42e7d2 27 void stepper::stepperMotor(PinName stepPin, PinName dirPin, PinName enPin, float period):step(stepPin), dir(dirPin), en(enPin), remain(0)
Dennis_Yu 1:bbb51c42e7d2 28 {
Dennis_Yu 1:bbb51c42e7d2 29 stepper.attach(&moveStepper, period);
Dennis_Yu 1:bbb51c42e7d2 30 }