ikarashiMDCの2byteバージョン
Dependents: NHK2019_mae_v6 NHK2019_main_v6 NHK2019_usiro_v6 2019BSyudo ... more
ikarashiMDC.cpp@14:d5ace3e9a620, 2019-08-30 (annotated)
- Committer:
- skouki
- Date:
- Fri Aug 30 06:42:26 2019 +0000
- Revision:
- 14:d5ace3e9a620
- Parent:
- 13:ea34af94e90c
- Child:
- 15:3ae22f7861b4
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
WAT34 | 0:314f2bed3958 | 1 | #include "ikarashiMDC.h" |
WAT34 | 0:314f2bed3958 | 2 | |
WAT34 | 0:314f2bed3958 | 3 | |
skouki | 14:d5ace3e9a620 | 4 | ikarashiMDC::ikarashiMDC(uint8_t taddr,uint8_t tmotorNum,bool tmode,Serial *tserial) |
WAT34 | 0:314f2bed3958 | 5 | { |
WAT34 | 2:75153205d6e8 | 6 | serial = tserial; |
WAT34 | 2:75153205d6e8 | 7 | addr = taddr; |
WAT34 | 2:75153205d6e8 | 8 | motorNum = tmotorNum; |
WAT34 | 2:75153205d6e8 | 9 | mode = tmode; |
WAT34 | 9:12ea2a3883bb | 10 | braking = true; |
WAT34 | 0:314f2bed3958 | 11 | } |
WAT34 | 0:314f2bed3958 | 12 | |
WAT34 | 2:75153205d6e8 | 13 | int ikarashiMDC::setSpeed(const double& speed) |
WAT34 | 0:314f2bed3958 | 14 | { |
skouki | 14:d5ace3e9a620 | 15 | uint8_t data[5],dataSpeed; |
WAT34 | 2:75153205d6e8 | 16 | //Limiter |
WAT34 | 13:ea34af94e90c | 17 | const double cropped_speed = std::min(1.0,std::max(-1.0,speed)); |
WAT34 | 2:75153205d6e8 | 18 | //dataspeed 0~253 neutaral 126 |
skouki | 14:d5ace3e9a620 | 19 | dataSpeed = ((cropped_speed+1.0)/2.0)*0xffff; |
WAT34 | 2:75153205d6e8 | 20 | //printf("%d\n",dataSpeed); |
WAT34 | 2:75153205d6e8 | 21 | //set sending data |
WAT34 | 2:75153205d6e8 | 22 | data[0] = 255; //header |
WAT34 | 7:a8fcb8df927a | 23 | data[1] = (addr<<5) + motorNum + (mode<<4)+(braking<<3); //address |
skouki | 14:d5ace3e9a620 | 24 | data[2] = dataSpeed & 0xff; |
skouki | 14:d5ace3e9a620 | 25 | data[3] = dataSpeed >> 8; |
skouki | 14:d5ace3e9a620 | 26 | data[4] = data[1]^data[2]^data[3]; |
WAT34 | 2:75153205d6e8 | 27 | //send data |
skouki | 14:d5ace3e9a620 | 28 | for(int i=0; i<5; i++) { |
WAT34 | 2:75153205d6e8 | 29 | serial->putc(data[i]); |
WAT34 | 2:75153205d6e8 | 30 | } |
WAT34 | 0:314f2bed3958 | 31 | return 0; |
WAT34 | 0:314f2bed3958 | 32 | } |
WAT34 | 0:314f2bed3958 | 33 | |
WAT34 | 2:75153205d6e8 | 34 | |
WAT34 | 2:75153205d6e8 | 35 | void estop(Serial *serial) |
WAT34 | 1:5e8014a1adbd | 36 | { |
WAT34 | 2:75153205d6e8 | 37 | for(int i = 0; i<3; i++) { |
WAT34 | 2:75153205d6e8 | 38 | serial->putc(255); |
WAT34 | 1:5e8014a1adbd | 39 | } |
WAT34 | 2:75153205d6e8 | 40 | |
WAT34 | 5:b43c03ee7f8b | 41 | } |