Project

General

Profile

Código de las funciones

#!/usr/bin/env pybricks-micropython

# Librerias
from pybricks.hubs import EV3Brick
from pybricks.ev3devices import Motor
from pybricks.parameters import Port
from pybricks.robotics import DriveBase

RobotGolf = EV3Brick
motor_izquierda = Motor(Port.A)
motor_derecha = Motor(Port.B)
motor_brazo = Motor(Port.D)
base_robot = DriveBase(motor_izquierda, motor_derecha, wheel_diameter = 55.5, axle_track = 100)

# Funciones
def avanzar():
    print("Avanzando...")
    base_robot.straight(-10)

def retroceder():
    print("Retrocediendo...")
    base_robot.straight(10)

def rotarDerecha():
    print("Rotando derecha...")
    base_robot.turn(-10)

def rotarIzquierda():
    print("Rotando izquierda...")
    base_robot.turn(10)

def golpeSuave():
    print("Golpe suave...")
    motor_brazo.run(100)

def golpeFuerte():
    print("Golpe fuerte...")
    motor_brazo.run(1000000)

def devolverBrazo():    
    print("Retrocediendo brazo...")
    motor_brazo.run(-100)

def detener():
    base_robot.stop()

def detenerBrazo():
    motor_brazo.stop()