My team is creating a drive code with a holonomic drivetrain. We’ve gotten the holonomic drive figured out, and the code successfully runs for that, but the rest of our bot won’t respond. Here’s the code:
FrontLeft.spin(FORWARD)
FrontRight.spin(FORWARD)
BackLeft.spin(FORWARD)
BackRight.spin(FORWARD)
while True:
FrontLeft.set_velocity((controller_1.axis3.position() + controller_1.axis4.position() + controller_1.axis1.position()), PERCENT)
BackLeft.set_velocity((controller_1.axis3.position() - controller_1.axis4.position() + controller_1.axis1.position()), PERCENT)
FrontRight.set_velocity((- controller_1.axis3.position() + controller_1.axis4.position() + controller_1.axis1.position()), PERCENT)
BackRight.set_velocity((- controller_1.axis3.position() - controller_1.axis4.position() + controller_1.axis1.position()), PERCENT)
Endgame.set_velocity(100, PERCENT)
Intake.set_velocity(100, PERCENT)
Flywheel.set_stopping(COAST)
Intake.set_stopping(COAST)
Puncher.set_velocity(100, PERCENT)
Puncher.set_stopping(COAST)
Endgame.set_stopping(HOLD)
while True:
controller_1.screen.clear_row(1)
controller_1.screen.set_cursor(controller_1.screen.row(), 1)
controller_1.screen.print("Speed%: ")
controller_1.screen.set_cursor(1, 8)
controller_1.screen.print(Flywheel.velocity(PERCENT))
controller_1.screen.set_cursor(1, 13)
controller_1.screen.print("Temp%: ")
controller_1.screen.set_cursor(1, 19)
controller_1.screen.print(Flywheel.temperature(PERCENT))
brain.screen.print("Distance: ")
brain.screen.set_cursor(1, 11)
brain.screen.set_cursor(1, 18)
brain.screen.print("inches")
wait(5, MSEC)
def y_pressed():
Flywheel.spin(FORWARD, 15.0, VOLT)
controller_1.buttonY.pressed(y_pressed)
def x_pressed():
Flywheel.spin(FORWARD, 0.76*12, VOLT)
controller_1.buttonX.pressed(x_pressed)
def b_pressed():
Flywheel.stop()
controller_1.buttonB.pressed(b_pressed)
def a_pressed():
Puncher.spin(FORWARD)
controller_1.buttonA.pressed(a_pressed)
def a_released():
Puncher.stop()
controller_1.buttonA.released(a_released)
Any help would be appreciated. Thanks!