update comp chassis

This commit is contained in:
ary 2023-09-22 10:25:50 -04:00
parent 9a41fd5767
commit 86df220938
2 changed files with 25 additions and 15 deletions

View File

@ -3,7 +3,10 @@
#include "lemlib/api.hpp"
#include "ary-lib/drive/drive.hpp"
#define TRACK_WDITH 11.5;
#define TRACK_WDITH 11.5
#define PLACEHOLDER_TC_OFFSET 2.5
#define WHEEL_SIZE 2.75
#define DRIVE_RATIO 0.75
namespace globals {
extern pros::Controller master;
@ -21,9 +24,13 @@ namespace globals {
extern pros::Motor_Group right_drive;
extern lemlib::Drivetrain_t chassis_odom;
extern Drive chassis;
extern pros::Rotation enc_left;
extern pros::Rotation enc_right;
extern pros::Rotation rot_vert;
extern pros::Rotation rot_horiz;
extern pros::Rotation enc_theta;
extern lemlib::TrackingWheel vert_tracking_wheel;
extern lemlib::TrackingWheel horiz_tracking_wheel;
extern Drive chassis;
}

View File

@ -14,32 +14,35 @@ namespace globals {
pros::Motor motor_brf(4, MOTOR_GEARSET_06, true);
pros::Motor motor_brb(4, MOTOR_GEARSET_06, true);
pros::Motor_Group left_drive({ motor_fl, motor_ml, motor_bl });
pros::Motor_Group right_drive({ motor_fr, motor_mr, motor_br });
pros::Motor_Group left_drive({ motor_tlf, motor_tlb, motor_blf, motor_blb });
pros::Motor_Group right_drive({ motor_trf, motor_trb, motor_brf, motor_brb });
// Electronics / Pneumatics / Sensors
pros::Rotation rot_vert(0);
pros::Rotation rot_horiz(1);
// pros::Rotation enc_right();
// pros::Rotation enc_theta();
lemlib::Drivetrain_t chassis_odom {
&left_drive,
&right_drive,
11.5,
2.75,
WHEEL_SIZE,
450
};
lemlib::TrackingWheel vert_tracking_wheel(&rot_vert, 2.75, PLACEHOLDER_TC_OFFSET, 1); // subject to change: p3 -> tracking center offset
lemlib::TrackingWheel hroiz_tracking_wheel(&rot_horiz, 2.75, PLACEHOLDER_TC_OFFSET, 1);
Drive chassis(
{-4,-4,-4,-4},
{1,1,1,1},
16,
3.125,
WHEEL_SIZE,
600,
0.6
DRIVE_RATIO
);
// Electronics / Pneumatics / Sensors
// pros::Rotation enc_left();
// pros::Rotation enc_right();
// pros::Rotation enc_theta();
// Misc
}