forked from Singam-Tech-Inc/Robot24B
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathOriginal drive Config.txt
20 lines (16 loc) · 1.7 KB
/
Original drive Config.txt
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
public static final int FRONT_LEFT_MODULE_DRIVE_MOTOR = 1; // Set front left module drive motor ID
public static final int FRONT_LEFT_MODULE_STEER_MOTOR = 2; // Set front left module steer motor ID
public static final int FRONT_LEFT_MODULE_STEER_ENCODER = 3; // Set front left steer encoder ID
public static final double FRONT_LEFT_MODULE_STEER_OFFSET = -Math.toRadians(301.113); // Measure and set front left steer offset
public static final int FRONT_RIGHT_MODULE_DRIVE_MOTOR = 4; // Set front right drive motor ID
public static final int FRONT_RIGHT_MODULE_STEER_MOTOR = 5; // Set front right steer motor ID
public static final int FRONT_RIGHT_MODULE_STEER_ENCODER = 6; // Set front right steer encoder ID
public static final double FRONT_RIGHT_MODULE_STEER_OFFSET = -Math.toRadians(238.096); // Measure and set front right steer offset
public static final int BACK_LEFT_MODULE_DRIVE_MOTOR = 7; // Set back left drive motor ID
public static final int BACK_LEFT_MODULE_STEER_MOTOR = 8; // Set back left steer motor ID
public static final int BACK_LEFT_MODULE_STEER_ENCODER = 9; // Set back left steer encoder ID
public static final double BACK_LEFT_MODULE_STEER_OFFSET = -Math.toRadians(55.283); // Measure and set back left steer offset
public static final int BACK_RIGHT_MODULE_DRIVE_MOTOR = 10; // Set back right drive motor ID
public static final int BACK_RIGHT_MODULE_STEER_MOTOR = 11; // Set back right steer motor ID
public static final int BACK_RIGHT_MODULE_STEER_ENCODER = 12; // Set back right steer encoder ID
public static final double BACK_RIGHT_MODULE_STEER_OFFSET = -Math.toRadians(157.764); // Measure and set back right steer offset