Shuto Naruse
/
Eurobot2012_Secondary
Eurobot2012_Secondary
Fork of Eurobot_2012_Secondary by
motors.h@0:fbfafa6bf5f9, 2012-04-20 (annotated)
- Committer:
- narshu
- Date:
- Fri Apr 20 21:32:24 2012 +0000
- Revision:
- 0:fbfafa6bf5f9
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
narshu | 0:fbfafa6bf5f9 | 1 | #ifndef MOTORS_H |
narshu | 0:fbfafa6bf5f9 | 2 | #define MOTORS_H |
narshu | 0:fbfafa6bf5f9 | 3 | |
narshu | 0:fbfafa6bf5f9 | 4 | #include "mbed.h" |
narshu | 0:fbfafa6bf5f9 | 5 | #include "TSH.h" |
narshu | 0:fbfafa6bf5f9 | 6 | |
narshu | 0:fbfafa6bf5f9 | 7 | class Motors { |
narshu | 0:fbfafa6bf5f9 | 8 | public: |
narshu | 0:fbfafa6bf5f9 | 9 | Motors(TSI2C &i2cin);//, Mutex ); |
narshu | 0:fbfafa6bf5f9 | 10 | //Motors(I2C &i2cin); |
narshu | 0:fbfafa6bf5f9 | 11 | |
narshu | 0:fbfafa6bf5f9 | 12 | //Functions declaration |
narshu | 0:fbfafa6bf5f9 | 13 | void disableAcceleration(); |
narshu | 0:fbfafa6bf5f9 | 14 | void resetEncoders(); |
narshu | 0:fbfafa6bf5f9 | 15 | int getEncoder1(); |
narshu | 0:fbfafa6bf5f9 | 16 | int getEncoder2(); |
narshu | 0:fbfafa6bf5f9 | 17 | void move(int distance, int speed); |
narshu | 0:fbfafa6bf5f9 | 18 | void turn(int angle, int speed); |
narshu | 0:fbfafa6bf5f9 | 19 | int getSignOfInt(int direction); |
narshu | 0:fbfafa6bf5f9 | 20 | void stop(); |
narshu | 0:fbfafa6bf5f9 | 21 | void setSpeed(int speed); |
narshu | 0:fbfafa6bf5f9 | 22 | void setSpeed(int speed1, int speed2); |
narshu | 0:fbfafa6bf5f9 | 23 | void setMode(int mode); |
narshu | 0:fbfafa6bf5f9 | 24 | float encoderToDistance(int encoder); |
narshu | 0:fbfafa6bf5f9 | 25 | int distanceToEncoder(float distance); |
narshu | 0:fbfafa6bf5f9 | 26 | void sendCommand(char command); |
narshu | 0:fbfafa6bf5f9 | 27 | void sendCommand(char command1, char command2 ); |
narshu | 0:fbfafa6bf5f9 | 28 | int get4Bytes(char command); |
narshu | 0:fbfafa6bf5f9 | 29 | |
narshu | 0:fbfafa6bf5f9 | 30 | |
narshu | 0:fbfafa6bf5f9 | 31 | private: |
narshu | 0:fbfafa6bf5f9 | 32 | I2C& i2c; |
narshu | 0:fbfafa6bf5f9 | 33 | //Mutex& |
narshu | 0:fbfafa6bf5f9 | 34 | |
narshu | 0:fbfafa6bf5f9 | 35 | //Constants declaration |
narshu | 0:fbfafa6bf5f9 | 36 | static const int md25Address = 0xB0; |
narshu | 0:fbfafa6bf5f9 | 37 | static const char cmdSetMotor1 = 0x00; |
narshu | 0:fbfafa6bf5f9 | 38 | static const char cmdSetMotor2 = 0x01; |
narshu | 0:fbfafa6bf5f9 | 39 | static const char cmdByte = 0x10; |
narshu | 0:fbfafa6bf5f9 | 40 | static const char cmdSetMode = 0x0F; |
narshu | 0:fbfafa6bf5f9 | 41 | static const char cmdResetEncoders = 0x20; |
narshu | 0:fbfafa6bf5f9 | 42 | static const char cmdGetEncoder1 = 0x02; |
narshu | 0:fbfafa6bf5f9 | 43 | static const char cmdGetEncoder2 = 0x06; |
narshu | 0:fbfafa6bf5f9 | 44 | static const char cmdDisableAcceleration = 0x30; |
narshu | 0:fbfafa6bf5f9 | 45 | }; |
narshu | 0:fbfafa6bf5f9 | 46 | |
narshu | 0:fbfafa6bf5f9 | 47 | #endif |