ank/ES3011
1
Fork 0
Code Releases Activity

Compare commits

base: ank:cc4d99c21899ced6a1e98f68faaf51a2d455928e
Branches Tags
ank:master
ank:velff
ank:cad
ank:submission
...
compare: ank:c97954b8159cc6c3f894a05032895a1d4a65c35a
Branches Tags
ank:velff
ank:master
ank:cad
ank:submission

2 commits
cc4d99c218 ... c97954b815

Author SHA1 Message Date
Andy Killorin
c97954b815
added coeff for left motor 2025-12-07 14:35:42 -05:00
Andy Killorin
a15dc3d11d
increased drive wheel shaft tolerance based on pololu documentation 2025-12-07 14:06:05 -05:00
3 changed files with 3 additions and 16 deletions
Show stats Expand all files Collapse all files

BIN
cad/Drive Wheel Tolerance Test.SLDPRT Normal file
View file

Binary file not shown.

BIN
cad/Drive Wheel-2.SLDPRT
View file

Binary file not shown.

19
robot_controller/robot_controller.ino
View file

@ -36,25 +36,12 @@ void setup() {
// TUNE VELOCITY PID // TUNE VELOCITY PID
left_motor.tune_vel_pid(0.9, 3.7,0.3,0.0); left_motor.tune_vel_pid(0.9, 3.7,0.3,0.0);
delay(10); delay(10);
right_motor.tune_vel_pid(0.0, 3.7,0.3,0.0); right_motor.tune_vel_pid(0.9, 3.7,0.3,0.0);
delay(10); delay(10);
right_motor.set_direction(PIDDirection::DIRECT); //right_motor.set_direction(PIDDirection::DIRECT);
uint16_t ratio = right_motor.get_gear_ratio();
Serial.print("ratio: ");
Serial.println(ratio);
ratio = left_motor.get_gear_ratio();
Serial.print("ratio: ");
Serial.println(ratio);
delay(1000); delay(1000);
// SET MOTOR POSITION
//int32_t angle=360;
//uint8_t status= left_motor.write_angle(angle);
//delay(1000);
// READ MOTOR POSITION // READ MOTOR POSITION
int32_t pos = left_motor.read_angle(); int32_t pos = left_motor.read_angle();
Serial.print("Pos: "); Serial.print("Pos: ");
@ -81,7 +68,7 @@ void loop() {
left_motor.write_rpm(setpoint.velocity * CMS_RPM); left_motor.write_rpm(setpoint.velocity * CMS_RPM);
delay(10); delay(10);
right_motor.write_rpm(robot_state == TURN ? -velocity : velocity); right_motor.write_rpm((robot_state == TURN ? velocity : -velocity) * CMS_RPM);
delay(10); delay(10);
// READ MOTOR POSITION // READ MOTOR POSITION