示例#1
0
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"):