NHK2017 octopus robot
Dependencies: 2017NHKpin_config mbed FEP ikarashiMDC PID jy901 omni HMC6352 omni_wheel
Fork of KANI2017v2 by
Diff: bot/elevator/elevator.cpp
- Revision:
- 23:37bb9afe9fdc
- Child:
- 25:d199d621ecca
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/bot/elevator/elevator.cpp Wed Sep 13 14:26:47 2017 +0900 @@ -0,0 +1,19 @@ +#include "elevator.h" + +Elevator::Elevator(DigitalOut* RS485Controller, Serial* RS485) : + elevatorMotor(RS485Controller, 1, 3, SM, RS485) +{ + elevatorMotor.braking = true; +} + +void Elevator::move(float speed) +{ + //if(speed*right.getPosition() < 0) speed = 0; + //if(speed*right.getPosition() > 0) right.resetPosition(); + elevatorMotor.setSpeed(speed); +} + +void Elevator::stop() +{ + elevatorMotor.setSpeed(0); +}