展旗(图一) 粮仓(图二) 主要代码

#Display the flag
'''

c.move([0,0,0,0,30,0,0,0])
time.sleep(1.25)
c.move([0,0,0,0,0,0,0,0])
time.sleep(5)

c.move([0,0,0,0,30,0,0,0])
time.sleep(1.25)
c.move([0,0,0,0,0,0,0,0])
'''

#Drop ball program
'''
c.move([0,0,0,0,0,10,0,0])
time.sleep(1.5)#1~1.7
c.move([0,0,0,0,0,-40,0,0])
time.sleep(2)
'''

#move函数
send_data_01_motor = comma_head_01_motor + left_front.to_bytes(1, byteorder='big', signed=True) + comma_trail
send_data_02_motor = comma_head_02_motor + right_front.to_bytes(1, byteorder='big',signed=True) + comma_trail
send_data_03_motor = comma_head_03_motor + left_rear.to_bytes(1, byteorder='big', signed=True) + comma_trail
send_data_04_motor = comma_head_04_motor + right_rear.to_bytes(1, byteorder='big', signed=True) + comma_trail
send_data_21_motor = comma_head_21_motor + m1.to_bytes(1, byteorder='big', signed=True) + comma_trail
send_data_22_motor = comma_head_22_motor + m2.to_bytes(1, byteorder='big',signed=True) + comma_trail
send_data_23_motor = comma_head_23_motor + m3.to_bytes(1, byteorder='big', signed=True) + comma_trail
send_data_24_motor = comma_head_24_motor + m4.to_bytes(1, byteorder='big', signed=True) + comma_trail

self.serial.write(send_data_01_motor)
self.serial.write(send_data_02_motor)
self.serial.write(send_data_03_motor)
self.serial.write(send_data_04_motor)

self.serial.write(send_data_21_motor)
self.serial.write(send_data_22_motor)
self.serial.write(send_data_23_motor)
self.serial.write(send_data_24_motor)