recnt dont dowmr
This commit is contained in:
29
main.py
29
main.py
@@ -17,9 +17,14 @@ left_motor = Motor(Ports.PORT2, GearSetting.RATIO_18_1, False)
|
|||||||
right_motor = Motor(Ports.PORT9, GearSetting.RATIO_18_1, True)
|
right_motor = Motor(Ports.PORT9, GearSetting.RATIO_18_1, True)
|
||||||
top_motor = Motor(Ports.PORT8, GearSetting.RATIO_18_1, False)
|
top_motor = Motor(Ports.PORT8, GearSetting.RATIO_18_1, False)
|
||||||
bottom_motor = Motor(Ports.PORT3, GearSetting.RATIO_18_1, True)
|
bottom_motor = Motor(Ports.PORT3, GearSetting.RATIO_18_1, True)
|
||||||
|
flip_motor = Motor(Ports.PORT11, GearSetting.RATIO_18_1, False)
|
||||||
run_bottom_motor = False
|
run_bottom_motor = False
|
||||||
run_invert_bottom_motor = False
|
run_invert_bottom_motor = False
|
||||||
speed_modifer = 1
|
speed_modifer = 1
|
||||||
|
flip = False
|
||||||
|
def run_flip():
|
||||||
|
global flip
|
||||||
|
flip = not flip
|
||||||
def intake():
|
def intake():
|
||||||
top_motor.spin(FORWARD, 100, PERCENT)
|
top_motor.spin(FORWARD, 100, PERCENT)
|
||||||
# bottom_motor.spin(FORWARD, 100, PERCENT)
|
# bottom_motor.spin(FORWARD, 100, PERCENT)
|
||||||
@@ -40,19 +45,28 @@ def run_run_bottom_motor():
|
|||||||
global run_bottom_motor
|
global run_bottom_motor
|
||||||
run_bottom_motor = not run_bottom_motor
|
run_bottom_motor = not run_bottom_motor
|
||||||
def user_control():
|
def user_control():
|
||||||
|
global run_bottom_motor
|
||||||
|
global run_invert_bottom_motor
|
||||||
|
global speed_modifer
|
||||||
|
global flip
|
||||||
brain.screen.clear_screen()
|
brain.screen.clear_screen()
|
||||||
brain.screen.print("driver control")
|
brain.screen.print("driver control")
|
||||||
controller.buttonA.pressed(run_run_invert_bottom_motor)
|
controller.buttonA.pressed(run_run_invert_bottom_motor)
|
||||||
bottom_motor.spin(FORWARD, 100, PERCENT)
|
bottom_motor.spin(FORWARD, 100, PERCENT)
|
||||||
controller.buttonY.pressed(run_run_bottom_motor)
|
controller.buttonY.pressed(run_run_bottom_motor)
|
||||||
|
controller.buttonUp.pressed(run_flip)
|
||||||
# button.pressed(intake)
|
# button.pressed(intake)
|
||||||
# button.released(intake(False))
|
# button.released(intake(False))
|
||||||
# place driver control in this while loop
|
# place driver control in this while loop
|
||||||
brain.screen.new_line()
|
brain.screen.new_line()
|
||||||
while True:
|
while True:
|
||||||
if controller.buttonR1.pressing():
|
if flip and flip_motor.position() == 90:
|
||||||
|
flip_motor.spin(FORWARD, 90, DEGREES)
|
||||||
|
else:
|
||||||
|
flip_motor.spin(REVERSE, 90, DEGREES)
|
||||||
|
if controller.buttonR1.pressing() and speed_modifer < 1:
|
||||||
speed_modifer = speed_modifer + 0.1
|
speed_modifer = speed_modifer + 0.1
|
||||||
if controller.buttonR2.pressing():
|
if controller.buttonR2.pressing() and speed_modifer > 0:
|
||||||
speed_modifer = speed_modifer - 0.1
|
speed_modifer = speed_modifer - 0.1
|
||||||
if controller.buttonB.pressing():
|
if controller.buttonB.pressing():
|
||||||
speed_modifer = 1
|
speed_modifer = 1
|
||||||
@@ -62,15 +76,18 @@ def user_control():
|
|||||||
brain.sdcard.savefile("motors/left_motor/efficiency.txt", bytearray(str(left_motor.efficiency())))
|
brain.sdcard.savefile("motors/left_motor/efficiency.txt", bytearray(str(left_motor.efficiency())))
|
||||||
brain.sdcard.savefile("motors/left_motor/temperature.txt", bytearray(str(left_motor.temperature())))
|
brain.sdcard.savefile("motors/left_motor/temperature.txt", bytearray(str(left_motor.temperature())))
|
||||||
if run_bottom_motor:
|
if run_bottom_motor:
|
||||||
if run_invert_bottom_motor:
|
# if run_invert_bottom_motor:
|
||||||
not run_invert_bottom_motor
|
# run_run_invert_bottom_motor()
|
||||||
bottom_motor.spin(FORWARD, 100, PERCENT)
|
bottom_motor.spin(FORWARD, 100, PERCENT)
|
||||||
top_motor.spin(FORWARD, 100 * speed_modifer, PERCENT)
|
top_motor.spin(FORWARD, 100 * speed_modifer, PERCENT)
|
||||||
elif run_invert_bottom_motor:
|
elif run_invert_bottom_motor:
|
||||||
if run_bottom_motor:
|
# if run_bottom_motor:
|
||||||
not run_bottom_motor
|
# run_run_bottom_motor()
|
||||||
bottom_motor.spin(REVERSE, 100, PERCENT)
|
bottom_motor.spin(REVERSE, 100, PERCENT)
|
||||||
top_motor.spin(REVERSE, 100, PERCENT)
|
top_motor.spin(REVERSE, 100, PERCENT)
|
||||||
|
# elif run_invert_bottom_motor:
|
||||||
|
# if run_bottom_motor:
|
||||||
|
# run_run_bottom_motor()
|
||||||
else:
|
else:
|
||||||
bottom_motor.stop()
|
bottom_motor.stop()
|
||||||
top_motor.stop()
|
top_motor.stop()
|
||||||
|
|||||||
Reference in New Issue
Block a user