utils/color_sensor_navi.py

@@ -1,41 +0,0 @@
-from pybricks.hubs import PrimeHub
-from pybricks.pupdevices import Motor, ColorSensor, UltrasonicSensor, ForceSensor
-from pybricks.parameters import Button, Color, Direction, Port, Side, Stop
-from pybricks.robotics import DriveBase
-from pybricks.tools import wait, StopWatch
-
-hub = PrimeHub()
-
-# Robot hardware configuration
ROBOT_CONFIG = {
    # Drive motors
    'left_motor': Motor(Port.A),
    'right_motor': Motor(Port.B),
    
    # Attachment motors
    'attachment_motor': Motor(Port.C),
    'lift_motor': Motor(Port.D),
    
    # Sensors
    'color_left': ColorSensor(Port.E),
    'color_right': ColorSensor(Port.F),
    'ultrasonic': UltrasonicSensor(Port.S1),
    
    # Hub reference
    'hub': hub
}

# Speed and distance constants
SPEEDS = {
    'FAST': 400,
    'NORMAL': 250,
    'SLOW': 100,
    'PRECISE': 50
}

DISTANCES = {
    'TILE_SIZE': 300,  # mm per field tile
    'ROBOT_LENGTH': 180,  # mm
    'ROBOT_WIDTH': 140    # mm
}
-
-
-def mission_run_1():
-    print('Running missions in Run 1')
-
-def mission_run_2():
-    print('Running missions in Run 2')
-
-def mission_run_3():
-    print('Running missions in Run 3')
-
-# In main.py - sensor-based navigation
-def main(self):
-    """Use color sensor to select runs"""
-    print("Place colored object in front of sensor:")
-    print("RED=Run1, GREEN=Run2, BLUE=Run3, YELLOW=Test")
-    while True:
-        color = ROBOT_CONFIG['color_left'].color()
-        if color == Color.RED:
-            mission_run_1()
-            break
-        elif color == Color.GREEN:
-            mission_run_2()
-            break
-        elif color == Color.BLUE:
-            mission_run_3()
-            break
-        elif color == Color.YELLOW:
-            self.test_mode()
-            break
-        wait(1000)
-main()