NHK2017 octopus robot

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

Fork of KANI2017v2 by NagaokaRoboticsClub_mbedTeam

bot/sword_unit/sword_unit.cpp

Committer:
number_key
Date:
2017-09-30
Revision:
25:d199d621ecca
Parent:
23:37bb9afe9fdc
Child:
26:7258d5ad0bff

File content as of revision 25:d199d621ecca:

#include "sword_unit.h"

Sword::Sword(DigitalOut* RS485Controller, Serial* RS485) :
  swordMotor(RS485Controller, 1, 3, SM, RS485)
{
	swordMotor.braking = true;
}

void Sword::move(float speed)
{
  //if(speed*right.getPosition() < 0)    speed = 0;
  //if(speed*right.getPosition() > 0)    right.resetPosition();
	swordMotor.setSpeed(speed);
}

void Sword::stop()
{
  swordMotor.setSpeed(0);
}