Test PS3 - Dribbler

Dependencies:   SerialArduino RCJESC

main.h

Committer:
piroro4560
Date:
2022-06-17
Revision:
0:97e795fb633f

File content as of revision 0:97e795fb633f:

#ifndef MAIN_H
#define MAIN_H

#include "mbed.h"

#define RobotNumberIsOne

#define PI 3.141592653//5897932

#define US1trig PC_8
#define US1echo PC_6
#define US2trig PC_5
#define US2echo PA_12
#define US3trig PA_11
#define US3echo PB_12
#define US4trig PB_2
#define US4echo PB_1
#define jyscl   PA_8
#define jysda   PB_4
#define IR      PC_2

#ifdef RobotNumberIsOne
#define Pin_motor_0 PA_6
#define Pin_motor_1 PA_15
#define Pin_motor_2 PB_6
#define Pin_motor_3 PA_7
#else
#define Pin_motor_0 PA_15
#define Pin_motor_1 PA_7
#define Pin_motor_2 PB_6
#define Pin_motor_3 PA_6
#endif

#define Pin_Kicker   PA_10
#define Pin_Dribbler PC_9

#define Pin_lcdscl  PB_8
#define Pin_lcdsda  PB_9

#define Pin_button   PC_3
#define Pin_toggle_0 PA_9
#define Pin_toggle_1 PB_10
#define Pin_toggle_2 PB_5

#endif