Diff: main.h

Revision:

0:97e795fb633f

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.h	Fri Jun 17 02:54:39 2022 +0000
@@ -0,0 +1,45 @@
+#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
\ No newline at end of file