Ryu Anzawa / Mbed OS Quadrifoglio_PS3COM

RoboCup RC Program

Dependencies:   omni_wheel PID jy901 solenoid Master kohiMD lpf SerialArduino RCJESC

main.h

Committer:
piroro4560
Date:
2022-06-18
Revision:
3:bff63180d3e6
Parent:
2:7da4a8e74955
Child:
5:232c0cfdec93

File content as of revision 3:bff63180d3e6:

#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