soft robotic fish 6 dummy test code for motors
Dependencies: mbed
Fork of robfish_test_pwm_allmotors by
Diff: main.cpp
- Revision:
- 0:c003ab5004eb
- Child:
- 1:1c924d93c011
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Sun Mar 20 02:58:11 2016 +0000 @@ -0,0 +1,35 @@ +/********************************************************************************* +* This code simply creates a pwm value for the BCU motor, valve motor, and pump +* motor. The BCU motor direction is governed by BCU_direction1 and +* BCU_direction2. If connected to a PC terminal, it prints out current readings. +*********************************************************************************/ + +#include "mbed.h" +using namespace std; + +Serial pc(USBTX, USBRX); +AnalogIn valve_current(p19); +AnalogIn bcu_current(p20); +PwmOut valve_pwm(p21); +PwmOut bcu_pwm(p22); +PwmOut motor_pwm(p23); +DigitalOut led2(LED2); +DigitalOut bcu_direction1(p11); +DigitalOut bcu_direction2(p12); + +int main() { + // set serial transfer rate + pc.baud(9600); + + valve_pwm = 0.8; + bcu_pwm = 0.8; + motor_pwm = 0.8; + + led2 = 1; + bcu_direction1 = 0; // BCU_direction1 must not equal BCU_direction2 for the BCU motor to turn + bcu_direction2 = 1; + + while(1) { + pc.printf("valve current percentage: %3.3f%%\n", valve_current.read()*100.0f); + } +} \ No newline at end of file