NHK2017 octopus robot

Dependencies:   2017NHKpin_config mbed FEP ikarashiMDC PID jy901 omni HMC6352 omni_wheel

Fork of KANI2017v2 by NagaokaRoboticsClub_mbedTeam

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);
+}