That-One-Nerd/ary-over-under
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

test stuff for bakary lib

Browse Source
This commit is contained in:
ary 2023-10-16 18:24:52 -04:00
parent 4b04df899b
commit 68cd006814
1 changed files with 21 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

28
RELENTLESS-Lite/src/autons.cpp
View File

@ -12,12 +12,20 @@ const int DRIVE_SPEED = 110;
const int TURN_SPEED = 101.5; const int TURN_SPEED = 101.5;
const int SWING_SPEED = 101.5; const int SWING_SPEED = 101.5;
void swingOther(void* p) { bool taskSwing = true;
chassisLeft.initialize();
chassisLeft.set_swing_pid(LEFT_SWING, 180, SWING_SPEED);
}
pros::Task swing_other(swingOther); void swingAsync() {
while (true) {
if (taskSwing) {
chassisRight.set_swing_pid(ary::RIGHT_SWING, 60, -SWING_SPEED);
pros::delay(10);
taskSwing = false;
}
pros::delay(10);
}
}
pros::Task swingTask(swingAsync);
void default_constants() { void default_constants() {
chassisRight.set_slew_min_power(80, 80); chassisRight.set_slew_min_power(80, 80);
@ -118,6 +126,12 @@ void test_second() {
} }
void arc_testing() { void arc_testing() {
chassisRight.set_swing_pid(RIGHT_SWING, 180, SWING_SPEED); while (true) {
swing_other.resume(); if (!taskSwing) {
chassisRight.set_swing_pid(ary::LEFT_SWING, 45, 110);
pros::delay(10);
taskSwing = true;
}
pros::delay(10);
}
} }