Robot secondaire
Dependencies: RoboClaw mbed StepperMotor
Fork of RoboClaw by
main.cpp
- Committer:
- sype
- Date:
- 2016-04-13
- Revision:
- 44:b1fd7489369f
- Parent:
- 43:d5aaff7d2bec
- Child:
- 45:b53ae54062c6
File content as of revision 44:b1fd7489369f:
#include "func.h" #define dt 10000 #define ATTENTE 0 #define GO 1 #define STOP 2 /* Déclaration des différents éléments de l'IHM */ InterruptIn mybutton(USER_BUTTON); DigitalIn button(USER_BUTTON); DigitalOut led(LED1); DigitalOut bleu(PC_5); DigitalOut blanc(PC_6); DigitalOut rouge(PC_8); /* AX12 */ AX12 left_hand(PA_15, PB_7, 4, 250000); AX12 right_hand(PA_15, PB_7, 1, 250000); /* Sharp */ AnalogIn capt1(PA_4); AnalogIn capt2(PB_0); AnalogIn capt3(PC_1); AnalogIn capt4(PC_0); /* Moteurs pas à pas */ Stepper RMot(NC, PB_10, PA_8); Stepper ZMot(NC, PB_5, PB_4); Stepper LMot(NC, PB_3, PA_10); /* Fins de course */ InterruptIn EndR(PB_15); InterruptIn EndZ(PB_14); InterruptIn EndL(PB_13); Ticker ticker; Serial logger(USBTX, USBRX); //Serial logger(PA_9, PA_10); RoboClaw roboclaw(460800, PA_11, PA_12); Odometry odo(61.7, 61.8, ENTRAXE, 4096, roboclaw); int i = 0, state = 0; bool EL = false, EZ = false, ER = false; void update_main(void); void init(void); /* Debut du programme */ int main(void) { init(); while(1) JPO(); } void init(void) { roboclaw.ForwardM1(ADR, 0); roboclaw.ForwardM2(ADR, 0); logger.baud(9600); logger.printf("Hello from main !\n\r"); wait_ms(500); bleu = 1, blanc = 1, rouge = 1; wait_ms(1000); bleu = 0, blanc = 0, rouge = 0; while(button); wait(1); init_ax12(); init_interrupt(); wait_ms(100); logger.printf("End init\n\r"); } void update_main(void) { odo.update_odo(); checkAround(); }