首页 / 专利库 / 电脑零配件 / 硬件实现 / 一种基于ROS的跑步运动员训练陪伴机器人

一种基于ROS的跑步运动员训练陪伴机器人

阅读:623发布:2020-05-08

专利汇可以提供一种基于ROS的跑步运动员训练陪伴机器人专利检索,专利查询,专利分析的服务。并且本 发明 公开了一种基于ROS的跑步运动员训练陪伴 机器人 ,属于机器人领域。包括 硬件 和 软件 ,硬件包括底座、转动装置、主控设备和 传感器 设备, 软件包 括自动行驶功能模 块 、机器人与运动员同步运行功能模块、数据保存功能模块、塑胶跑道 数据处理 模块、 激光雷达 数据处理模块和PID调节模块。本发明解决运动员在训练过程中不了解自己的跑步姿势、过弯道 加速 情况、直线冲刺情况等问题,实现了具有保持与运动员同步行驶、根据设定速度自主沿着跑道行驶、保存运动员运动视频、保存运动员运动速度和 低 电压 报警提示功能的跑步运动员训练陪伴机器人。,下面是一种基于ROS的跑步运动员训练陪伴机器人专利的具体信息内容。

1.一种基于ROS的跑步运动员训练陪伴机器人,包括硬件软件,其特征在于:
所述硬件包括底座、转动装置、主控设备和传感器设备,所述转动装置包括前驱动轮、后从动轮、电机机和电子调速器,所述前驱动轮和后从动轮分别安装在底座的前端和后端,所述前驱动轮与后从动轮通过转轴传动连接,所述电机安装在底座前端用以驱动所述前驱动轮,所述前驱动轮和后从动轮上均连接有舵机,所述舵机的输出轴上设有平衡板,所述平衡板两端均固定连接有弹簧,所述舵机与主控设备电连接,所述电子调速器安装所述底座上,所述电子调速器分别与电机和主控设备电连接;
所述主控设备包括工控机和底层控制器,所述工控机和所述底层控制器均安装在底座上,所述工控机与所述底层控制器进行传输连接,所述底层控制器通过采集所述传感器设备的数据解算出机器人当前的姿态和实际的速度,并将姿态数据和实际速度上传给工控机,所述工控机与所述舵机电连接,所述底层控制器与电子调速器电连接;
所述传感器设备包括第一摄像头、第二摄像头、激光雷达、光电编码器和驱动电源,所述第一摄像头、第二摄像头和激光雷达均与所述工控机电连接,所述第一摄像头位于底座的前端,所述底座上设有支架,所述第二摄像头和激光雷达均设置在所述支架上,所述光电编码器安装在底座上,所述光电编码器与所述底层控制器电连接;所述驱动电源设置在所述底座的侧面,所述驱动电源分别与所述工控机和底层控制器电连接;
所述软件包括自动行驶功能模、机器人与运动员同步运行功能模块、数据保存功能模块、塑胶跑道数据处理模块、激光雷达数据处理模块和PID调节模块;所述自动行驶功能模块分别与所述第一摄像头、第二摄像头、激光雷达传输连接,所述自动行驶功能模块用于接收第一摄像头、第二摄像头拍摄并处理后的数据以便控制机器人沿塑胶跑道按设定的速度自动行驶;所述机器人与运动员同步运行功能模块与所述自动行驶功能模块连接,所述机器人与运动员同步运行功能模块用于控制跑步运动员训练陪伴机器人与运动员保持同步行驶;所述数据保存功能模块与所述塑胶跑道数据处理模块连接,所述数据保存功能模块用于将第一摄像头拍摄获取的塑胶跑道图像处理并保存,所述塑胶跑道数据处理模块用于将第二摄像头拍摄获取的塑胶跑道图像处理并保存;所述激光雷达数据模块与所述机器人与运动员同步运行功能模块连接,所述激光雷达数据模块用于处理激光雷达获取运动员与机器人距离的数据并反馈给所述机器人与运动员同步运行功能模块;所述PID调节模块与所述工控机块连接,所述PID调节模块用于调节所述工控机反馈回来的前驱动轮速度。
2.根据权利要求1所述的一种基于ROS的跑步运动员训练陪伴机器人,其特征在于:所述底层控制器与工控机采用TTL串口通信方式,使用CP2102作为串口通信芯片。
3.根据权利要求2所述的一种基于ROS的跑步运动员训练陪伴机器人,其特征在于:所述底层控制器使用ISP方式下载程序,并在所述串口通信芯片的电路基础上增加串口一键下载电路。
4.根据权利要求1所述的一种基于ROS的跑步运动员训练陪伴机器人,其特征在于:还包括报警器、第一差动齿轮箱、以及第二差动齿轮箱,所述报警器设在所述底座上,所述报警器与驱动电源电连接;所述第一差动齿轮箱设在所述底座前部用于控制前驱动轮,所述第二差动齿轮箱设在所述底座后部用于控制后从动轮。
5.根据权利要求1所述的一种基于ROS的跑步运动员训练陪伴机器人,其特征在于:所述自动行驶功能模块在控制陪伴机器人沿塑胶跑道自动的行驶过程包括以下步骤:
A1.先设定机器人沿塑胶跑道的行驶速度;
A2.通过所述第一摄像头拍摄的图像,对跑道数据进行处理;
A3.观察机器人是否冲出跑道,若机器人没冲出跑道,执行步骤A4,若机器人冲出跑道,将速度设置为1m/s,执行步骤A5;
A4.若塑胶跑道数据处理模块中输出的斜率为0,保持机器人行驶;若斜率不为0,执行步骤A5;
A5.调整舵机转向,执行步骤A6;
A6.采用PID调节模块调整电机输出使斜率为0。
6.根据权利要求1所述的一种基于ROS的跑步运动员训练陪伴机器人,其特征在于:所述机器人与运动员同步运行功能模块在控制机器人与运动员保持同步行驶的过程包括以下步骤:
B1.先保持机器人静止状态,由所述激光雷达获取机器人与运动员的距离,调整机器人与运动员的距离为2.5m;
B2.在机器人与运动员同步运行功能模块上的显示屏读取数据,机器人与运动员的距离是否大于2.5m,若距离大于2.5m,实行步骤B1,若距离小于2.5m,实行步骤B3;
B3.对跑道数据进行处理;
B4.在机器人与运动员同步运行功能模块上的显示屏读取数据,机器人与跑道的斜率是否为0,若斜率不为0,执行步骤B5,若斜率为0,执行步骤B6;
B5.调整舵机转向;
B6.在机器人与运动员同步运行功能模块上的显示屏读取数据,若机器人和运动员距离不等于2.5m,执行步骤B7,若机器人和运动员距离等于2.5m,保持机器人行驶;
B7.采用PID调节模块调整电机输出使机器人与运动员的距离等于2.5m。
7.根据权利要求5所述的一种基于ROS的跑步运动员训练陪伴机器人,其特征在于:所述数据保存功能模块在处理塑胶跑道图像的过程包括以下步骤:
C1.打开第一摄像头,获取当前系统的时间,然后创建视频流文件;
C2.获取所述自动行驶功能模块上的机器人速度数据,将获取到的数据转为文本叠加在当前图像中,将当前帧图像写入视频流文件;
C3.在自动行驶功能模块上的显示屏读取速度数据,如果获取的机器人速度数据与设定的速度不相同,则获取下一帧图像,重复C3步骤;如果获取的机器人速度数据与设定的速度相同,则结束获取图像,释放视频流文件,最后结束进程
8.根据权利要求5所述的一种基于ROS的跑步运动员训练陪伴机器人,其特征在于:所述塑胶跑道数据处理模块采用RGB和HSV格式对图像进行处理,且包括以下步骤:
D1.打开第二摄像头,读取当前帧图像;
D2.将图像的RBG格式转换成HSV格式,利用迭代阈值分割,采用透视变换,将直方图与投影变换,进行滑动窗口搜索,提取跑道线坐标集,进行多项式拟合,将斜率输出和备份;
D3.在自动行驶功能模块上的显示屏读取速度数据,若机器人的速度与设定的速度相同,结束提取图像;若机器人速度数据与设定的速度不相同,程序继续进行读取下一帧图像,重复D2步骤。
9.根据权利要求6所述的一种基于ROS的跑步运动员训练陪伴机器人,其特征在于:所述激光雷达数据处理模块在处理运动员与机器人的距离数据包括以下步骤:
E1.驱动激光雷达进行数据采集,获取正负15度范围的距离,计算与设定距离的误差,并采用PID调节模块调整电机输出,若误差为0,不用调节PID调节模块,若误差不为0,采用PID调节模块调整电机输出使得机器人与运动员的距离等于2.5m;
E2.在机器人行驶过程中,在激光雷达数据处理模块上的显示屏读取数据,若采集的运动员与机器人距离等于2.5m,结束采集;若采集的运动员与机器人距离不等于2.5m,重复E1步骤。
10.根据权利要求1所述的一种基于ROS的跑步运动员训练陪伴机器人,其特征在于:所述PID调节模块在调节前驱动轮速度的过程包括以下步骤:
F1.采集所述电子调节器发出的速度数据;
F2.在PID调节模块上的显示屏读取数据,若数据与设定的速度数据不一致,则通过电子调节器来调节前驱动轮速度与设定的速度数据相同;若数据与设定的速度数据相同,则不用调节前驱动轮的速度。

说明书全文

一种基于ROS的跑步运动员训练陪伴机器人

技术领域

[0001] 本发明涉及机器人领域,尤其是一种基于ROS的跑步运动员训练陪伴机器人。

背景技术

[0002] 随着人们生活平的提高和科学技术的发展,陪伴机器人也渐渐步入了我们的眼球,影响跑步运动员提升训练成绩主要有起跑姿势不正确、过弯道加速时间不对、直线冲刺时间不对、跑步过程中摆臂方式不正确、没有使用合适自己个人情况的训练方式等等因素。而跑步运动员训练陪伴机器人能够记录运动员的起跑姿势、过弯道加速情况、直线冲刺情况、跑步过程中摆臂情况、调节在跑道中加减速的位置、录制运动员跑步的整个过程。根据长期的训练数据制定出适合自己实际情况的训练方法,让运动员按照科学数据来进行训练更好的提升训练成绩。斜率,是表示一条直线(或曲线的切线)关于(横)坐标轴倾斜程度的量,它通常用直线(或曲线的切线)与(横)坐标轴夹的正切,或两点的纵坐标之差与横坐标之差的比来表示。通过斜率的值我们可以得知机器人的行驶路线是否为直线。
[0003] 目前设计的陪伴机器人主要是面向老龄群体和小孩群体,能为跑步运动员提供训练方法改进的陪伴机器人较少,而且现有的机器人不能全面记录运动员训练情况和训练数据,不能为运动员提供一种优良的改进方案。

发明内容

[0004] 本发明的发明目的是,针对上述问题,提供一种基于ROS的跑步运动员训练陪伴机器人,解决运动员在训练过程中不能知道自己的跑步姿势、过弯道加速情况、直线冲刺情况等问题,实现了具有保持与运动员同步行驶、根据设定速度自主沿着跑道行驶、保存运动员运动视频、保存运动员运动速度和电压报警提示功能的跑步运动员训练陪伴机器人。
[0005] 为达到上述目的,本发明所采用的技术方案是:一种基于ROS的跑步运动员训练陪伴机器人,包括硬件软件,所述硬件包括底座、转动装置、主控设备和传感器设备,所述转动装置包括前驱动轮、后从动轮、电机机和电子调速器,所述前驱动轮和后从动轮分别安装在底座的前端和后端,所述前驱动轮与后从动轮通过转轴传动连接,所述电机安装在底座前端用以驱动所述前驱动轮,所述前驱动轮和后从动轮上均连接有舵机,所述舵机的输出轴上设有平衡板,所述平衡板两端均固定连接有弹簧,所述舵机与主控设备电连接,所述电子调速器安装所述底座上,所述电子调速器分别与电机和主控设备电连接。
[0006] 所述主控设备包括工控机和底层控制器,所述工控机和所述底层控制器均安装在底座上,所述工控机与所述底层控制器进行传输连接,所述底层控制器通过采集所述传感器设备的数据解算出机器人当前的姿态和实际的速度,并将姿态数据和实际速度上传给工控机,所述工控机与所述舵机电连接,所述底层控制器与电子调速器电连接。
[0007] 所述传感器设备包括第一摄像头、第二摄像头、激光雷达、光电编码器和驱动电源,所述第一摄像头、第二摄像头和激光雷达均与所述工控机电连接,所述第一摄像头位于底座的前端,所述底座上设有支架,所述第二摄像头和激光雷达均设置在所述支架上,所述光电编码器安装在底座上,所述光电编码器与所述底层控制器电连接;所述驱动电源设置在所述底座的侧面,所述驱动电源分别与所述工控机和底层控制器电连接。
[0008] 所述软件包括自动行驶功能模、机器人与运动员同步运行功能模块、数据保存功能模块、塑胶跑道数据处理模块、激光雷达数据处理模块和PID调节模块;所述自动行驶功能模块分别与所述第一摄像头、第二摄像头、激光雷达传输连接,所述自动行驶功能模块用于接收第一摄像头、第二摄像头拍摄并处理后的数据以便控制机器人沿塑胶跑道按设定的速度自动行驶;所述机器人与运动员同步运行功能模块与所述自动行驶功能模块连接,所述机器人与运动员同步运行功能模块用于控制跑步运动员训练陪伴机器人与运动员保持同步行驶;所述数据保存功能模块与所述塑胶跑道数据处理模块连接,所述数据保存功能模块用于将第一摄像头拍摄获取的塑胶跑道图像处理并保存,所述塑胶跑道数据处理模块用于将第二摄像头拍摄获取的塑胶跑道图像处理并保存;所述激光雷达数据模块与所述机器人与运动员同步运行功能模块连接,所述激光雷达数据模块用于处理激光雷达获取运动员与机器人距离的数据并反馈给所述机器人与运动员同步运行功能模块;所述PID调节模块与所述工控机块连接,所述PID调节模块用于调节所述工控机反馈回来的前驱动轮速度。
[0009] 进一步的,所述底层控制器与工控机采用TTL串口通信方式,使用CP2102作为串口通信芯片。
[0010] 进一步的,所述底层控制器使用ISP方式下载程序,并在所述串口通信芯片的电路基础上增加串口一键下载电路。
[0011] 进一步的,还包括报警器、第一差动齿轮箱、以及第二差动齿轮箱,所述报警器设在所述底座上,所述报警器与驱动电源电连接;所述第一差动齿轮箱设在所述底座前部用于控制前驱动轮,所述第二差动齿轮箱设在所述底座后部用于控制后从动轮。
[0012] 进一步的,所述自动行驶功能模块在控制陪伴机器人沿塑胶跑道自动的行驶过程包括以下步骤:
[0013] A1.先设定机器人沿塑胶跑道的行驶速度;
[0014] A2.通过所述第一摄像头拍摄的图像,对跑道数据进行处理;
[0015] A3.观察机器人是否冲出跑道,若机器人没冲出跑道,执行步骤A4,若机器人冲出跑道,将速度设置为1m/s,执行步骤A5;
[0016] A4.若塑胶跑道数据处理模块中输出的斜率为0,保持机器人行驶;若斜率不为0,执行步骤A5;
[0017] A5.调整舵机转向,执行步骤A6;
[0018] A6.采用PID调节模块调整电机输出使斜率为0。
[0019] 进一步的,所述机器人与运动员同步运行功能模块在控制机器人与运动员保持同步行驶的过程包括以下步骤:
[0020] B1.先保持机器人静止状态,由所述激光雷达获取机器人与运动员的距离,调整机器人与运动员的距离为2.5m;
[0021] B2.在机器人与运动员同步运行功能模块上的显示屏读取数据,机器人与运动员的距离是否大于2.5m,若距离大于2.5m,实行步骤B1,若距离小于2.5m,实行步骤B3;
[0022] B3.对跑道数据进行处理;
[0023] B4.在机器人与运动员同步运行功能模块上的显示屏读取数据,机器人与跑道的斜率是否为0,若斜率不为0,执行步骤B5,若斜率为0,执行步骤B6;
[0024] B5.调整舵机转向;
[0025] B6.在机器人与运动员同步运行功能模块上的显示屏读取数据,若机器人和运动员距离不等于2.5m,执行步骤B7,若机器人和运动员距离等于2.5m,保持机器人行驶;
[0026] B7.采用PID调节模块调整电机输出使机器人与运动员的距离等于2.5m。
[0027] 进一步的,所述数据保存功能模块在处理塑胶跑道图像的过程包括以下步骤:
[0028] C1.打开第一摄像头,获取当前系统的时间,然后创建视频流文件;
[0029] C2.获取所述自动行驶功能模块上的机器人速度数据,将获取到的数据转为文本叠加在当前图像中,将当前帧图像写入视频流文件;
[0030] C3.在自动行驶功能模块上的显示屏读取速度数据,如果获取的机器人速度数据与设定的速度不相同,则获取下一帧图像,重复C3步骤;如果获取的机器人速度数据与设定的速度相同,则结束获取图像,释放视频流文件,最后结束进程
[0031] 进一步的,所述塑胶跑道数据处理模块采用RGB和HSV格式对图像进行处理,且包括以下步骤:
[0032] D1.打开第二摄像头,读取当前帧图像;
[0033] D2.将图像的RBG格式转换成HSV格式,利用迭代阈值分割,采用透视变换,将直方图与投影变换,进行滑动窗口搜索,提取跑道线坐标集,进行多项式拟合,将斜率输出和备份;
[0034] D3.在自动行驶功能模块上的显示屏读取速度数据,若机器人的速度与设定的速度相同,结束提取图像;若机器人速度数据与设定的速度不相同,程序继续进行读取下一帧图像,重复D2步骤。
[0035] 进一步的,所述激光雷达数据处理模块在处理运动员与机器人的距离数据包括以下步骤:
[0036] E1.驱动激光雷达进行数据采集,获取正负15度范围的距离,计算与设定距离的误差,并采用PID调节模块调整电机输出,若误差为0,不用调节PID调节模块,若误差不为0,采用PID调节模块调整电机输出使得机器人与运动员的距离等于2.5m;
[0037] E2.在机器人行驶过程中,在激光雷达数据处理模块上的显示屏读取数据,若采集的运动员与机器人距离等于2.5m,结束采集;若采集的运动员与机器人距离不等于2.5m,重复E1步骤。
[0038] 进一步的,所述PID调节模块在调节前驱动轮速度的过程包括以下步骤:
[0039] F1.采集所述电子调节器发出的速度数据;
[0040] F2.在PID调节模块上的显示屏读取数据,若数据与设定的速度数据不一致,则通过电子调节器来调节前驱动轮速度与设定的速度数据相同;若数据与设定的速度数据相同,则不用调节前驱动轮的速度。
[0041] 由于采用上述技术方案,本发明具有以下有益效果:
[0042] 本发明使用STM32F407作为主芯片的底层控制器,在其外围接入增量式编码器获取小车当前的速度,接入报警器作为提示信息,使用安全开关对机器人待机状态下定动输出,激光雷达用于获取机器人和运动员的距离,第一摄像头获取跑道数据和第二摄像头录制运动员运动过程及处理运动员与机器人的动态图像数据,采用电子调速器驱动电机,使用角度舵机用于控制机器人的运动转向;使用工控机处理距离数据、跑道数据、录制运动员运动过程的视频,底层控制器发布线速度和角速度传输给工控机从而调整电机输出控制机器人与运动员保持同步运动。
[0043] 由于底层控制器需要有个简单便捷升级程序的方式,STM32F407芯片支持JATA、SWD、USB、ISP等方式下载程序。跑步运动员训练陪伴机器人底层控制器使用ISP方式下载,在串口通信电路基础上增加串口一键下载电路,只需要使用与工控机通信的USB数据线即可完成固件的升级。
[0044] 使用CP2102作为串口通信芯片,该芯片具有稳定性强、内部自带晶振、所需外围器件少的优点。
[0045] 驱动电源检测到电压低于电池最低电压后会发出报警提示,及时对电池进行充电防止锂电池过放。附图说明
[0046] 图1是本发明结构示意图。
[0047] 图2是本发明机器人结构的后视图。
[0048] 图3是本发明总体连接示意图。
[0049] 图4是本发明的TTL串口通信电路图。
[0050] 图5是本发明的ISP一键下载电路图。
[0051] 图6是本发明的报警器电路图。
[0052] 图7是本发明的光电编码器接口电路图。
[0053] 图8是本发明自主行驶功能流程图
[0054] 图9是本发明中机器人和运动员同步运行功能流程图。
[0055] 图10是本发明运动员数据保存功能流程图。
[0056] 附图中,1-底座、2-前驱动轮、3-后从动轮、4-第一差动齿轮箱、5-第二差动齿轮箱、6-电机、7-转轴、8-舵机、9-第一摄像头、10-第二摄像头、11-激光雷达、12-支架、13-报警器。

具体实施方式

[0057] 以下结合附图对发明的具体实施进一步说明。
[0058] 根据图1-7所示,所述硬件包括底座1、转动装置、主控设备和传感器设备,所述转动装置包括前驱动轮2、后从动轮3、电机6、舵机8和电子调速器,所述前驱动轮2和后从动轮3分别安装在底座1的前端和后端,所述前驱动轮2与后从动轮3通过转轴7传动连接,所述电机6安装在底座1前端用以驱动所述前驱动轮2,所述前驱动轮2和后从动轮3上均连接有舵机8,所述舵机8的输出轴上设有平衡板,所述平衡板两端均固定连接有弹簧,所述舵机8与主控设备电连接,所述电子调速器安装所述底座1上,所述电子调速器分别与电机6和主控设备电连接。所述主控设备包括工控机和底层控制器,所述工控机和所述底层控制器均安装在底座1上,所述工控机与所述底层控制器进行传输连接,所述底层控制器通过采集所述传感器设备的数据解算出机器人当前的姿态和实际的速度,并将姿态数据和实际速度上传给工控机,所述工控机与所述舵机8电连接,所述底层控制器与电子调速器电连接。其中,电机6为无刷电机。如图4和图5所示,所述底层控制器与工控机采用TTL串口通信方式,使用CP2102作为串口通信芯片;所述底层控制器使用ISP方式下载程序,并在所述串口通信芯片的电路基础上增加串口一键下载电路。本发明还包括报警器13、第一差动齿轮箱4、以及第二差动齿轮箱5,所述报警器13设在所述底座1上,所述报警器13与驱动电源电连接;所述第一差动齿轮箱4设在所述底座1前部用于控制前驱动轮2,所述第二差动齿轮箱5设在所述底座1后部用于控制后从动轮3。
[0059] 在本实施例中,所述传感器设备包括第一摄像头9、第二摄像头10、激光雷达11、光电编码器和驱动电源,所述第一摄像头9、第二摄像头10和激光雷达11均与所述工控机电连接,所述第一摄像9头位于底座1的前端,所述底座1上设有支架12,所述第二摄像头10和激光雷达11均设置在所述支架12上,所述光电编码器安装在底座1上,所述光电编码器与所述底层控制器电连接;所述驱动电源设置在所述底座1的侧面,所述驱动电源分别与所述工控机和底层控制器电连接。
[0060] 所述软件包括自动行驶功能模块、机器人与运动员同步运行功能模块、数据保存功能模块、塑胶跑道数据处理模块、激光雷达数据处理模块和PID调节模块;所述自动行驶功能模块分别与所述第一摄像头9、第二摄像头10、激光雷达11传输连接,所述自动行驶功能模块用于接收第一摄像头9、第二摄像头10拍摄并处理后的数据以便控制机器人沿塑胶跑道按设定的速度自动行驶;所述机器人与运动员同步运行功能模块与所述自动行驶功能模块连接,所述机器人与运动员同步运行功能模块用于控制跑步运动员训练陪伴机器人与运动员保持同步行驶;所述数据保存功能模块与所述塑胶跑道数据处理模块连接,所述数据保存功能模块用于将第一摄像头9拍摄获取的塑胶跑道图像处理并保存,所述塑胶跑道数据处理模块用于将第二摄像头10拍摄获取的塑胶跑道图像处理并保存;所述激光雷达11数据模块与所述机器人与运动员同步运行功能模块连接,所述激光雷达数据模块用于处理激光雷达获取运动员与机器人距离的数据并反馈给所述机器人与运动员同步运行功能模块;所述PID调节模块与所述工控机块连接,所述PID调节模块用于调节所述工控机反馈回来的前驱动轮速度。
[0061] 作为本实施例更进一步的技术方案,如图8所示,所述自动行驶功能模块在控制陪伴机器人沿塑胶跑道自动的行驶过程包括以下步骤:
[0062] A1.先设定机器人沿塑胶跑道的行驶速度;
[0063] A2.通过所述第一摄像头9拍摄的图像,对跑道数据进行处理;
[0064] A3.观察机器人是否冲出跑道,若机器人没冲出跑道,执行步骤A4,若机器人冲出跑道,将速度设置为1m/s,执行步骤A5;
[0065] A4.若塑胶跑道数据处理模块中输出的斜率为0,保持机器人行驶;若斜率不为0,执行步骤A5;
[0066] A5.调整舵机8转向,执行步骤A6;
[0067] A6.采用PID调节模块调整电机输出使斜率为0。
[0068] 作为本实施例更进一步的技术方案,如图9所示,所述机器人与运动员同步运行功能模块在控制机器人与运动员保持同步行驶的过程包括以下步骤:
[0069] B1.先保持机器人静止状态,由所述激光雷达11获取机器人与运动员的距离,调整机器人与运动员的距离为2.5m;
[0070] B2.在机器人与运动员同步运行功能模块上的显示屏读取数据,机器人与运动员的距离是否大于2.5m,若距离大于2.5m,实行步骤B1,若距离小于2.5m,实行步骤B3;
[0071] B3.对跑道数据进行处理;
[0072] B4.在机器人与运动员同步运行功能模块上的显示屏读取数据,机器人与跑道的斜率是否为0,若斜率不为0,执行步骤B5,若斜率为0,执行步骤B6;
[0073] B5.调整舵机转向;
[0074] B6.在机器人与运动员同步运行功能模块上的显示屏读取数据,若机器人和运动员距离不等于2.5m,执行步骤B7,若机器人和运动员距离等于2.5m,保持机器人行驶;
[0075] B7.采用PID调节模块调整电机输出使机器人与运动员的距离等于2.5m。
[0076] 在跑道数据处理中透视变换主要用于进行视角转换,把机器人摄像头平视图转换为俯视图,它的本质是通过变换公式将当前图像投影到一个新的视图平面。
[0077] 作为本实施例更进一步的技术方案,如图10所示,所述数据保存功能模块在处理塑胶跑道图像的过程包括以下步骤:
[0078] C1.打开第一摄像头9,获取当前系统的时间,然后创建视频流文件;
[0079] C2.获取所述自动行驶功能模块上的机器人速度数据,将获取到的数据转为文本叠加在当前帧图像中,将当前帧图像写入视频流文件;
[0080] C3.在自动行驶功能模块上的显示屏读取速度数据,如果获取的机器人速度数据与设定的速度不相同,则获取下一帧图像,重复C3步骤;如果获取的机器人速度数据与设定的速度相同,则结束获取图像,释放视频流文件,最后结束进程。
[0081] 作为本实施例更进一步的技术方案,所述塑胶跑道数据处理模块采用RGB和HSV格式对图像进行处理,且包括以下步骤:
[0082] D1.打开第二摄像头10,读取当前帧图像;
[0083] D2.将图像的RBG格式转换成HSV格式,利用迭代阈值分割,采用透视变换,将直方图与投影变换,进行滑动窗口搜索,提取跑道线坐标集,进行多项式拟合,将斜率输出和备份;
[0084] D3.在自动行驶功能模块上的显示屏读取速度数据,若机器人的速度与设定的速度相同,结束提取图像;若机器人速度数据与设定的速度不相同,程序继续进行读取下一帧图像,重复D2步骤。
[0085] 作为本实施例更进一步的技术方案,所述激光雷达数据处理模块在处理运动员与机器人的距离数据包括以下步骤:
[0086] E1.驱动激光雷达进行数据采集,获取正负15度范围的距离,计算与设定距离的误差,并采用PID调节模块调整电机输出,若误差为0,不用调节PID调节模块,若误差不为0,采用PID调节模块调整电机输出使得机器人与运动员的距离等于2.5m;
[0087] E2.在机器人行驶过程中,在激光雷达数据处理模块上的显示屏读取数据,若采集的运动员与机器人距离等于2.5m,结束采集;若采集的运动员与机器人距离不等于2.5m,重复E1步骤。
[0088] 作为本实施例更进一步的技术方案,所述PID调节模块在调节前驱动轮速度的过程包括以下步骤:
[0089] F1.采集所述电子调节器发出的速度数据;
[0090] F2.在PID调节模块上的显示屏读取数据,若数据与设定的速度数据不一致,则通过电子调节器来调节前驱动轮速度与设定的速度数据相同;若数据与设定的速度数据相同,则不用调节前驱动轮的速度。
[0091] 本发明使用STM32F407作为主芯片的底层控制器,在其外围接入增量式编码器获取小车当前的速度,接入报警器13(蜂鸣器)作为提示信息,采用安全开关对机器人待机状态下锁定动力输出,激光雷达11为搭载思岚A2型号,用于获取机器人和运动员的距离,使用第一摄像头9获取跑道数据和第二摄像头9录制运动员运动过程的视频,利用电子调速器驱动电机6,使用角度舵机8用于控制机器人的运动转向;使用工控机(i5-5250U Mimi PC)作为顶层控制器,负责处理激光雷达数据、跑道数据、录制运动员运动过程视频,给底层控制器发布线速度和角速度从而控制机器人与运动员保持同步运动。
[0092] 上述说明是针对本发明较佳可行实施例的详细说明,但实施例并非用以限定本发明的专利申请范围,凡本发明所提示的技术精神下所完成的同等变化或修饰变更,均应属于本发明所涵盖专利范围。
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈