Speed Assignment Biorobotics

Dependencies:   Encoder mbed

Committer:
dbayuadi
Date:
Wed Sep 23 07:52:51 2015 +0000
Revision:
0:c4fba4d6195f
Speed Assignment;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
dbayuadi 0:c4fba4d6195f 1 #include "mbed.h"
dbayuadi 0:c4fba4d6195f 2 #include "encoder.h"
dbayuadi 0:c4fba4d6195f 3 Serial pc(USBTX, USBRX); // tx, rx
dbayuadi 0:c4fba4d6195f 4 Encoder motor1_pos(D13,D12);
dbayuadi 0:c4fba4d6195f 5 DigitalOut motor1(D4);
dbayuadi 0:c4fba4d6195f 6 PwmOut motorspeed1(D5);
dbayuadi 0:c4fba4d6195f 7 PwmOut motorspeed2(D6);
dbayuadi 0:c4fba4d6195f 8 DigitalOut motor2(D7);
dbayuadi 0:c4fba4d6195f 9 const int on = 0;
dbayuadi 0:c4fba4d6195f 10 const int off = 1;
dbayuadi 0:c4fba4d6195f 11 const float frequency = 1000.0;
dbayuadi 0:c4fba4d6195f 12
dbayuadi 0:c4fba4d6195f 13 int main()
dbayuadi 0:c4fba4d6195f 14 {
dbayuadi 0:c4fba4d6195f 15 motorspeed2.period(1/frequency);
dbayuadi 0:c4fba4d6195f 16 while (true) {
dbayuadi 0:c4fba4d6195f 17
dbayuadi 0:c4fba4d6195f 18 for(float b=0.0f ; b<1.1f ; b+=0.1f)
dbayuadi 0:c4fba4d6195f 19 {
dbayuadi 0:c4fba4d6195f 20 motor2.write(on);
dbayuadi 0:c4fba4d6195f 21 motorspeed2.write(b);
dbayuadi 0:c4fba4d6195f 22 pc.printf("b is %f\n",b);
dbayuadi 0:c4fba4d6195f 23 wait(1);
dbayuadi 0:c4fba4d6195f 24
dbayuadi 0:c4fba4d6195f 25 }
dbayuadi 0:c4fba4d6195f 26
dbayuadi 0:c4fba4d6195f 27 }
dbayuadi 0:c4fba4d6195f 28 }