在VREP实现基于视觉的小车PID循迹(python)

本文介绍如何在VREP环境中使用Python实现基于视觉的小车PID循迹。通过Canny算法检测路径并计算偏离误差,利用PID控制器进行轨迹跟踪。同时,还实现了简单的模板匹配障碍物检测,根据图像信息调整小车差速。
摘要由CSDN通过智能技术生成

在Vrep中设置路径和pioneer小车,网络上已有较多通信配置的优秀教程 这里不再班门弄斧。相机位置安装在小车上方。

 主要思路是通过canny检测路径曲线,通过某一列曲线和画面中心的距离,确定偏离的误差,通过PID控制器进行跟踪

vrep.simxFinish(-1) # 闭所有与VREP之前的连接
clientID = vrep.simxStart('127.0.0.1',19997,True,True,5000,5)  # 参数解释可查看API文档
if clientID!=-1:  #检查连接是否成功
    print ('Connected to remote API server')  
    #template_init begin
    template = cv2.imread("model.jpg")
    #template_init end
    #bot connection begin
    robot = Robot()
    fz = FZ()
    while True:
        # rgb
        res,resolution,image = vrep.simxGetVisionSensorImage(clientID,robot.visionSensor,0,vrep.simx_opmode_streaming)
        time.sleep(0.
  • 0
    点赞
  • 8
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 3
    评论
循迹控制是机器人控制中的一个重要应用场景,其中 PID 控制器是一种常用的控制算法。在树莓派上实现循迹控制需要相应的硬件和软件支持。 硬件方面,你需要一辆小车,同时安装循迹传感器并将其连接到树莓派上。循迹传感器可以检测小车所在的轨道,并输出相应的信号,以便树莓派进行控制。此外,你还需要购买电机和电调板,以便树莓派控制小车的运动。 软件方面,你需要在树莓派上安装 Python 和相关的库,如 GPIO、RPi.GPIO 和 numpy。然后,你可以使用 PID 算法来控制小车的运动。PID 算法可以根据当前偏差、偏差变化率和偏差积分值来计算输出信号,以便调整小车的方向和速度。 以下是一个基本的循迹 PID 控制程序的示例代码: ```python import RPi.GPIO as GPIO import time import numpy as np # 设置 GPIO 引脚模式 GPIO.setmode(GPIO.BOARD) # 定义引脚号 left_pin = 11 mid_pin = 13 right_pin = 15 motor1_pin1 = 16 motor1_pin2 = 18 motor2_pin1 = 22 motor2_pin2 = 24 # 设置引脚为输入模式 GPIO.setup(left_pin, GPIO.IN) GPIO.setup(mid_pin, GPIO.IN) GPIO.setup(right_pin, GPIO.IN) # 设置引脚为输出模式 GPIO.setup(motor1_pin1, GPIO.OUT) GPIO.setup(motor1_pin2, GPIO.OUT) GPIO.setup(motor2_pin1, GPIO.OUT) GPIO.setup(motor2_pin2, GPIO.OUT) # 定义 PID 参数 Kp = 0.5 Ki = 0.1 Kd = 0.2 # 定义 PID 变量 last_error = 0 integral = 0 # 定义循迹 PID 控制函数 def track_pid(): # 读取传感器信号 left = GPIO.input(left_pin) mid = GPIO.input(mid_pin) right = GPIO.input(right_pin) # 计算偏差 error = left - right # 计算偏差变化率 delta_error = error - last_error # 计算偏差积分值 integral += error # 计算输出信号 output = Kp * error + Ki * integral + Kd * delta_error # 更新 PID 变量 last_error = error # 控制小车运动 if output > 0: GPIO.output(motor1_pin1, GPIO.HIGH) GPIO.output(motor1_pin2, GPIO.LOW) GPIO.output(motor2_pin1, GPIO.HIGH) GPIO.output(motor2_pin2, GPIO.LOW) else: GPIO.output(motor1_pin1, GPIO.LOW) GPIO.output(motor1_pin2, GPIO.HIGH) GPIO.output(motor2_pin1, GPIO.LOW) GPIO.output(motor2_pin2, GPIO.HIGH) # 延时一段时间 time.sleep(0.1) # 循环执行循迹 PID 控制函数 while True: track_pid() ``` 在这个示例代码中,我们使用 GPIO 库来控制树莓派的引脚,使用 numpy 库来进行数学计算。我们定义了三个循迹传感器,分别对应左、中、右三个位置。在每次循迹 PID 控制函数中,我们读取传感器信号,并根据 PID 算法计算输出信号,以控制小车的运动。最后,我们使用一个无限循环来不断执行循迹 PID 控制函数。 你可以根据自己的需要调整 PID 参数,以获得更好的控制效果。同时,你还可以添加其他功能,如超声波避障、图像识别等,以进一步提高小车的智能化水平。
评论 3
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

心本忧

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值