Seiya Ono
/
active_test
active test code
Diff: main.cpp
- Revision:
- 0:99038ba270aa
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Fri Aug 10 16:55:18 2018 +0000 @@ -0,0 +1,49 @@ +#include "mbed.h" + +DigitalOut led1(PTC5); + +DigitalOut leds[5] = { PTE6, PTE5, PTE4 ,PTE3, PTE2 }; +int power[5] = { 0, 25, 50, 75, 100 }; + +DigitalOut m1(PTA5); +PwmOut pwm1(PTA13); +AnalogIn fb1(PTB2); + +Serial pc(USBTX, USBRX); + +void setMotor(int p) +{ + pc.printf("Motor at %d%% power\n\r", p); + pwm1.write(p); +} + +int main() +{ + pc.printf("Starting Active System test...\n\r"); + wait(0.5); + pwm1.period(4.0f); + + while (true) { + pc.printf("---- Forward Test ----\n\r"); + led1 = 1; + m1 = 0; + for ( int i = 0; i < 5; i++ ) { + setMotor(power[i]); + leds[i] = 1; + printf("Current Reading: %f\n\r", fb1); + wait(1); + leds[i] = 0; + } + + pc.printf("---- Backwards Test ----\n\r"); + led1 = 0; + m1 = 1; + for ( int i = 0; i < 5; i++ ) { + setMotor(power[i]); + leds[i] = 1; + printf("Current Reading: %f\n\r", fb1); + wait(1); + leds[i] = 0; + } + } +} \ No newline at end of file