当前位置：首页 > news >正文

PART 6 树莓派小车+QT （TCP控制）

news 2025/9/18 2:15:10

1. 树莓派作为服务器的程序

（1）服务器tcp_server_socket程序

可以实现小车前进、后退、左转、右转、加减速（可能不行）

carMoveControl.py

import  RPi.GPIO as GPIO
import time
import tty,sys,select,termios
import socket
import string
import threading
import carMoverun_car  = '1'  #鎸夐敭鍓?back_car = '2'  #鎸夐敭鍚?left_car = '3'  #鎸夐敭宸?right_car = '4' #鎸夐敭鍙?stop_car = '0'  #鎸夐敭鍋?#灏忚溅鐘舵€佸€煎畾涔?enSTOP = 0
enRUN =1
enBACK = 2
enLEFT = 3
enRIGHT = 4
enTLEFT =5
enTRIGHT = 6#灏忚溅鍜岃埖鏈虹姸鎬佸彉閲?g_CarState = 0
g_ServoState = 0
#灏忚溅閫熷害鍙橀噺recvbuf = ""try:#閫氳繃socket鍒涘缓鐩戝惉濂楁帴瀛楀苟璁剧疆涓洪潪闃诲妯″紡tcp_server_socket= socket.socket(socket.AF_INET,socket.SOCK_STREAM)#濉厖缁戝畾鏈嶅姟鍣ㄧ殑ip鍦板潃鍜岀鍙ｅ彿#娉ㄦ剰锛氳繖閲屼竴瀹氳鏍规嵁鑷繁鐨勬爲鑾撴淳鐨刬p鍦板潃鏉ュ～porttcp_server_socket.bind(("", 6002))tcp_server_socket.listen(128)  #tcp_server_socket.setblocking(0)  #鐩戝惉瀹㈡埛绔殑杩炴帴while True:  print ("waiting for connection....")     tcp_client_socket,tcp_client_addr = tcp_server_socket.accept()print ("Start recv!")if tcp_server_socket:connectflag = 1print ("new user :%s " % str(tcp_client_addr))#璁剧疆杩炴帴濂楁帴瀛椾负闈為樆濉炵殑妯″紡骞跺皢杩炴帴鐨勫鎺ュ瓧鏀惧叆鍒扮洃鍚垪琛ㄤ腑#TCP鎺ュ彈鏁版嵁while True:recvbuf = tcp_client_socket.recv(128)print(recvbuf)global speedspeed = 30#TCP鎺ュ彈鏁版嵁if recvbuf == b"$0,0,0,0,0,0,1,0,0,0#": # speed upspeed += 5print ("Car Speed is : %d", speed)if speed > 100:speed = 100 #灏忚溅鍔犻€?            elif recvbuf == b"$0,0,0,0,0,0,2,0,0,0#": # speed downspeed -= 5if speed < 10:  #灏忚溅鍑忛€?                    speed= 10  print ("Car Speed is : %d", speed)elif recvbuf == b"$1,0,0,0,0,0,0,0,0,0#":carMove.goForward()elif recvbuf == b"$2,0,0,0,0,0,0,0,0,0#":carMove.goBackward()elif recvbuf == b"$3,0,0,0,0,0,0,0,0,0#":carMove.turnLeft()elif recvbuf == b"$4,0,0,0,0,0,0,0,0,0#":carMove.turnRight()            elif recvbuf == b"$0,0,0,0,0,0,0,0,0,0#":                    carMove.motorStop()  else:breaktcp_client_socket.close()print ("Start recv over!")tcp_client_socket.close()
except KeyboardInterrupt:passGPIO.cleanup()

调用的小车程序 carMove.py

import  RPi.GPIO as GPIO
import time
import tty,sys,select,termiosrun_car  = '1'  #鎸夐敭鍓?back_car = '2'  #鎸夐敭鍚?left_car = '3'  #鎸夐敭宸?right_car = '4' #鎸夐敭鍙?stop_car = '0'  #鎸夐敭鍋? speed = 20#璁剧疆GPIO鍙ｄ负BCM缂栫爜鏂瑰紡
GPIO.setmode(GPIO.BCM)#蹇界暐璀﹀憡淇℃伅
GPIO.setwarnings(False)# AIN涓哄乏鍓嶈疆
P1_PWMA, P1_AIN1, P1_AIN2 = 26, 13,19
# AIN涓哄乏鍚庤疆
P1_PWMA1, P1_AIN11, P1_AIN22 = 17, 22, 27# BIN涓哄彸鍓嶈疆
P2_PWMB, P2_BIN1, P2_BIN2 = 25, 24, 23
# BIN涓哄彸鍚庤疆
P2_PWMB1, P2_BIN11, P2_BIN22 = 16, 21, 20#宸︿晶杞瓙P1 = [P1_PWMA, P1_AIN1, P1_AIN2,P1_PWMA1, P1_AIN11, P1_AIN22]#鍙充晶杞瓙
P2 = [P2_PWMB, P2_BIN1, P2_BIN2,P2_PWMB1, P2_BIN11, P2_BIN22]#PWM浣跨敤10000Hz鐨勯鐜囨晥鏋滆緝濂斤紝杈撳叆鐨勮皟閫熷尯闂翠负0锝?00,浣嗚皟閫熶负5宸﹀彸鏃朵篃鏄彲浠ョЩ鍔↙_Up_Motor= GPIO.PWM(P1_PWMA,10000)GPIO.setup(P1,GPIO.OUT)
GPIO.setup(P2,GPIO.OUT)
L_Up_Motor = GPIO.PWM(P1_PWMA,10000)
L_Up_Motor.start(0)
L_Down_Motor = GPIO.PWM(P1_PWMA1,10000)
L_Down_Motor.start(0)
R_Up_Motor= GPIO.PWM(P2_PWMB,10000)R_Up_Motor.start(0) R_Down_Motor = GPIO.PWM(P2_PWMB1,10000)
R_Down_Motor.start(0)# A 0 1 姝?   A1 1 0 姝?      B 0  1 姝?  B1  1  0姝? 
#宸﹁浆 A 0 0 鍙? A1 0 1 鍙?        B 0  1    B1   0    0    zuozhuan:zuocez fanzhuan, youce zhengzhuan
Diretion = [[0,0, 0,0, 0,0, 0,0],[0,1, 1,0, 0,1, 1,0],[1,0, 0,1, 1,0, 0,1],[1,0, 0,1, 0,1, 1,0],  [0,1, 1,0, 1,0, 0,1]  ]
#瀹氫箟鏂瑰悜  def DIRETION(diretion):GPIO.output(P1_AIN1,diretion[0]) #AIN1GPIO.output(P1_AIN2,diretion[1]) #AIN2   P1_AIN2涓哄乏鍓嶈疆GPIO.output(P1_AIN11,diretion[2]) #AIN2   P1_AIN2涓哄乏鍚庤疆GPIO.output(P1_AIN22,diretion[3]) #AIN1GPIO.output(P2_BIN1,diretion[4]) #BIN2  BIN涓哄彸鍓嶈疆 GPIO.output(P2_BIN2,diretion[5]) #BIN1GPIO.output(P2_BIN11,diretion[6]) #BIN1     GPIO.output(P2_BIN22,diretion[7]) #BIN2  BIN涓哄彸鍚庤疆 def reset():GPIO.output(13, GPIO.LOW)GPIO.output(19, GPIO.LOW)GPIO.output(22, GPIO.LOW)GPIO.output(27, GPIO.LOW)GPIO.output(24, GPIO.LOW)GPIO.output(23, GPIO.LOW)GPIO.output(21, GPIO.LOW)GPIO.output(20, GPIO.LOW)#     A = {'s': 0, 'w':1, 'b':2, 'l':3,'r':4}def goForward( ):DIRETION(Diretion[1])L_Up_Motor.ChangeDutyCycle(speed)L_Down_Motor.ChangeDutyCycle(speed)R_Up_Motor.ChangeDutyCycle(speed)R_Down_Motor.ChangeDutyCycle(speed)def goBackward( ):DIRETION(Diretion[2])L_Up_Motor.ChangeDutyCycle(speed)L_Down_Motor.ChangeDutyCycle(speed)R_Up_Motor.ChangeDutyCycle(speed)R_Down_Motor.ChangeDutyCycle(speed)def turnLeft( ):DIRETION(Diretion[3])L_Up_Motor.ChangeDutyCycle(speed)L_Down_Motor.ChangeDutyCycle(speed)R_Up_Motor.ChangeDutyCycle(speed)R_Down_Motor.ChangeDutyCycle(speed)def turnRight( ):DIRETION(Diretion[4])L_Up_Motor.ChangeDutyCycle(speed)L_Down_Motor.ChangeDutyCycle(speed)R_Up_Motor.ChangeDutyCycle(speed)R_Down_Motor.ChangeDutyCycle(speed)def motorStop( ):DIRETION(Diretion[0])L_Up_Motor.ChangeDutyCycle(0)L_Down_Motor.ChangeDutyCycle(0)R_Up_Motor.ChangeDutyCycle(0)R_Down_Motor.ChangeDutyCycle(0)''' 
try:goForward()time.sleep(2)goBackward()time.sleep(2)turnLeft()time.sleep(2)turnRight()time.sleep(2)time.sleep(1)reset()GPIO.cleanup()except KeyboardInterrupt:pass
'''