from ev3.ev3dev import Motor import time def init_motor(motor): print ("Initializing motor") motor.reset() motor.run_mode = 'forever' motor.stop_mode = Motor.STOP_MODE.BRAKE motor.regulation_mode = True motor.pulses_per_second_sp = 0 motor.start() print ("Motor Initialized") return; a = Motor(port=Motor.PORT.A) b = Motor(port=Motor.PORT.B) init_motor(a) init_motor(b) a.pulses_per_second_sp = 2000 b.pulses_per_second_sp = 2000 time.sleep(5) a.pulses_per_second_sp = 0 b.pulses_per_second_sp = 0;
#def pitch(direction): #up/down UDP_IP = "10.42.0.3" UDP_PORT = 5005 sock = socket.socket(socket.AF_INET, socket.SOCK_DGRAM) sock.bind((UDP_IP,UDP_PORT)) print "Robot awaiting commands..." while True: data, addr = sock.recvfrom(1024) if(data=="right"): leftTrackMotor.pulses_per_second_sp = 100 rightTrackMotor.pulses_per_second_sp = -100 leftTrackMotor.start() rightTrackMotor.start() elif(data=="left"): leftTrackMotor.pulses_per_second_sp = -100 rightTrackMotor.pulses_per_second_sp = 100 leftTrackMotor.start() rightTrackMotor.start() elif(data=="pitchup"): servoArmPitchMotor.pulses_per_second_sp = -100 servoArmPitchMotor.start() elif(data=="pitchdown"): servoArmPitchMotor.pulses_per_second_sp = 100 servoArmPitchMotor.start() elif(data=="rollleft"):