NagaokaRoboticsClub_mbedTeam / ikarashiMDC_2byte_ver

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?

        

            
                
UserRevisionLine numberNew 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

}