from machine import Pin, ADC
import time
import run

turn_left = Pin(2, Pin.OUT)
turn_right = Pin(19, Pin.OUT)

analogPinX = ADC(Pin(34))
analogPinY = ADC(Pin(35))
analogPinX.atten(ADC.ATTN_11DB)
analogPinY.atten(ADC.ATTN_11DB)

run.main()

main.py

diagram.json

from machine import Pin, ADC
import time

# Initialize pins
turn_left = Pin(2, Pin.OUT)
turn_right = Pin(19, Pin.OUT)
forward = Pin(18, Pin.OUT)
backward = Pin(15, Pin.OUT)

# Initialize ADC pins
analogPinX = ADC(Pin(34))
analogPinY = ADC(Pin(35))
analogPinX.atten(ADC.ATTN_11DB)
analogPinY.atten(ADC.ATTN_11DB)
swpin = Pin(23, Pin.IN, Pin.PULL_UP)  # Change to input with pull-up resistor

# Initial state
ready_to_receive = False

def read_analog_values():
    analogXVal = analogPinX.read()
    analogYVal = analogPinY.read()
    print(f'Horizontal: {analogXVal} Vertical: {analogYVal}')
    return analogXVal, analogYVal

def read_swjoy_values():
    swjoyVal = swpin.value()
    print(f'SW pin: {swjoyVal}')
    return swjoyVal

def h_control_motors(analogXVal):
    if analogXVal > 2048:
        turn_left.value(0)
        turn_right.value(1)
        print("motor left start")
    elif analogXVal < 2048:
        turn_right.value(0)
        turn_left.value(1)
        print("motor right start")
    else:
        turn_right.value(1)
        turn_left.value(1)
        #print("motor stop")

def v_control_motors(analogYVal):
    if analogYVal > 2048:
        forward.value(0)
        backward.value(1)
        print("motor move forward")
    elif analogYVal < 2048:
        forward.value(0)
        backward.value(1)
        print("motor move backward")
    else:
        forward.value(1)
        backward.value(1)
        #print("STOP")

def sw_control_motor():
    global ready_to_receive
    if swpin.value() == 0:  # Check if the switch is pressed
        ready_to_receive = not ready_to_receive  # Toggle the state
        print("Ready to receive commands" if ready_to_receive else "Not ready to receive commands")
        time.sleep(0.3)  # Debounce delay

def main():
    while True:
        try:
            sw_control_motor()
            if ready_to_receive:
                analogXVal, analogYVal = read_analog_values()
                h_control_motors(analogXVal)
                v_control_motors(analogYVal)
            time.sleep(0.1)
        except OSError as e:
            print(e)

if __name__ == "__main__":
    main()