![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
Crude navigation
Dependencies: GPS L3GD20 LSM303DLHC mbed PID
move.h
- Committer:
- Spilly
- Date:
- 2015-02-21
- Revision:
- 0:e79311aae7ed
File content as of revision 0:e79311aae7ed:
//L298n connections DigitalOut pinI1(D5); DigitalOut pinI2(D6); DigitalOut pinI3(D10); DigitalOut pinI4(D11); PwmOut ENA(D12); //Left PwmOut ENB(D13); //Right void goStop(float valueOne, float valueTwo) { pinI1 = 0; pinI2 = 0; pinI3 = 0; pinI4 = 0; ENA = valueOne; ENB = valueTwo; } void goForward(float valueOne, float valueTwo) { pinI1 = 1; pinI2 = 0; pinI3 = 0; pinI4 = 1; ENA = valueOne; ENB = valueTwo; } void goBackward(float valueOne, float valueTwo) { pinI1 = 0; pinI2 = 1; pinI3 = 1; pinI4 = 0; ENA = valueOne; ENB = valueTwo; } void goLeft(float valueOne, float valueTwo) { pinI1 = 0; pinI2 = 1; pinI3 = 0; pinI4 = 1; ENA = valueOne; ENB = valueTwo; } void goRight(float valueOne, float valueTwo) { pinI1 = 1; pinI2 = 0; pinI3 = 1; pinI4 = 0; ENA = valueOne; ENB = valueTwo; }