DERPS
Dependencies: BMP280 BNO055_fusion PowerControl mbed
Fork of STRAIGHT_DRIVE_NO_SEP by
LOCOMOTION.h
- Committer:
- 12104404
- Date:
- 2016-03-29
- Revision:
- 17:2f89826b5679
- Parent:
- 16:d6f15a13c3aa
- Child:
- 18:f9012e93edb8
File content as of revision 17:2f89826b5679:
#ifndef LOCOMOTION_H #define LOCOMOTION_H #include "mbed.h" #include "LOCALIZE.h" #define SPEED_TURN_MIN 0.20 #define SPEED_TURN_MAX 0.65 enum { ANGLE_TURN = 0, ANGLE_BIAS = 1, }; class LOCOMOTION { public: LOCOMOTION(PinName motor1F, PinName motor1B,PinName motor2F, PinName motor2B, PinName forward1, PinName forward2); PwmOut _m1f; PwmOut _m1b; PwmOut _m2f; PwmOut _m2b; DigitalOut _m1dir; DigitalOut _m2dir; bool setXPos(int target, int current, int error); bool setYPos(int target, int current, int error); bool setAngle(int target, int current, int error, int mode); int wrap(int num); protected: float s; }; #endif