ikarashiMDCの2byteバージョン
Dependents: NHK2019_mae_v6 NHK2019_main_v6 NHK2019_usiro_v6 2019BSyudo ... more
ikarashiMDC.cpp
- Committer:
- skouki
- Date:
- 2019-08-30
- Revision:
- 14:d5ace3e9a620
- Parent:
- 13:ea34af94e90c
- Child:
- 15:3ae22f7861b4
File content as of revision 14:d5ace3e9a620:
#include "ikarashiMDC.h" ikarashiMDC::ikarashiMDC(uint8_t taddr,uint8_t tmotorNum,bool tmode,Serial *tserial) { serial = tserial; addr = taddr; motorNum = tmotorNum; mode = tmode; braking = true; } int ikarashiMDC::setSpeed(const double& speed) { uint8_t data[5],dataSpeed; //Limiter const double cropped_speed = std::min(1.0,std::max(-1.0,speed)); //dataspeed 0~253 neutaral 126 dataSpeed = ((cropped_speed+1.0)/2.0)*0xffff; //printf("%d\n",dataSpeed); //set sending data data[0] = 255; //header data[1] = (addr<<5) + motorNum + (mode<<4)+(braking<<3); //address data[2] = dataSpeed & 0xff; data[3] = dataSpeed >> 8; data[4] = data[1]^data[2]^data[3]; //send data for(int i=0; i<5; i++) { serial->putc(data[i]); } return 0; } void estop(Serial *serial) { for(int i = 0; i<3; i++) { serial->putc(255); } }