Bayu Dharmaputra
/
Speed_Assignment
Speed Assignment Biorobotics
main.cpp@0:c4fba4d6195f, 2015-09-23 (annotated)
- Committer:
- dbayuadi
- Date:
- Wed Sep 23 07:52:51 2015 +0000
- Revision:
- 0:c4fba4d6195f
Speed Assignment;
Who changed what in which revision?
User | Revision | Line number | New 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 | } |