一种追踪光源点机器人的实验装置制造方法及图纸

本发明专利技术公开了一种追踪光源点机器人的实验装置，包括图片信号采集装置和小车驱动装置；小车驱动装置包括：电机驱动模块、数据处理控制器和供电模块；图片信号采集装置用于采集外部图片数据，并将图片数据发送给数据处理控制器；数据处理控制器用于根据图片数据，生成PWM驱动信号，并将PWM驱动信号发送给电机驱动模块，以使电机驱动模块调节小车驱动装置的行进速度，实现光源点的自动追踪。采用本发明专利技术实施例，能带领初学者走进光源点机器人领域，提高学生的学习兴趣和主观能动性。

An experimental device for tracking the point robot of light source

The invention discloses an experimental device for tracking a light point robot, including a picture signal acquisition device and a car driving device, which includes a motor drive module, a data processing controller and a power supply module, and a picture signal acquisition device is used to collect the external picture data and send the picture data to the data. The data processing controller is used to generate the PWM drive signal according to the picture data and send the PWM drive signal to the motor drive module, so that the motor drive module can adjust the moving speed of the car driving device and realize the automatic tracking of the light source point. By adopting the embodiment of the invention, a beginner can guide a beginner into the field of light source and point robot, so as to improve students' interest in learning and subjective initiative.

【技术实现步骤摘要】
一种追踪光源点机器人的实验装置
本专利技术涉及机器人
，尤其涉及一种追踪光源点机器人的实验装置。
技术介绍
随着科技的发展和人们生活水平的提高，人们对智能产品的需求与要求也不断地提高。但是也往往忽略一点就是如何让更多开发者能更加容易地去开辟一个全新的领域。每一个领域虽然都有一个开辟者，但是光只有一个开辟者是远远不够的，一个新领域需要更多的能力者去不断开拓它。譬如后来学习者想要进入光源点机器人这个新的领域，这需要学习图像识别技术和电机调控技术，一般高校的电气类电子信息类的专业都有开设电机调速这门课程，但图像识别这个技术许多高校都没有开设。现有技术中并没有相关的学习装置或实验装置可以带领初学者入门到光源点机器人领域，从而引起学生的学习兴趣，提高学习主观能动性。
技术实现思路
本专利技术实施例提出一种追踪光源点机器人的实验装置，能带领初学者走进光源点机器人领域，提高学生的学习兴趣和主观能动性。本专利技术实施例提供一种追踪光源点机器人的实验装置，包括：图片信号采集装置和小车驱动装置；所述小车驱动装置包括：电机驱动模块、数据处理控制器和供电模块；所述数据处理控制器分别与所述图片信号采集装置、电机驱动模块、供电模块连接；所述供电模块分别与所述图片信号采集装置、电机驱动模块连接；所述图片信号采集装置用于采集外部图片数据，并将所述图片数据发送给所述数据处理控制器；所述数据处理控制器用于根据所述图片数据，生成PWM驱动信号，并将所述PWM驱动信号发送给电机驱动模块，以使所述电机驱动模块调节所述小车驱动装置的行进速度，实现光源点的自动追踪。进一步的，所述数据处理控制器用于根据所述图片数据，生成PWM驱动信号，具体为：根据预设的颜色参数、图片矩形尺寸、横向PID速度比值和纵向PID速度比值，建立内部直角坐标系；根据所述图片数据中的颜色，生成图片矩阵，并将所述图片矩阵与所述内部直角坐标系进行对比，获得横轴与纵轴的偏差值；根据所述横轴与纵轴的偏差值，结合PID运算，计算得出横轴与纵轴的输出值；将横轴输出值乘以横轴PID速度比值定义为横向转弯速度，将纵轴输出值乘以纵轴PID速度比值定义为纵向进退速度；根据所述横向转弯速度和所述纵向进退速度，生成PWM驱动信号。进一步的，所述图片信号采集装置为图片传感器。进一步的，所述图片传感器是型号为OV7725的图片传感器。进一步的，所述数据处理控制器是型号为STM32F765VGT6的处理器。进一步的，所述电机驱动模块是型号为TB6612FNG的电机驱动模块。实施本专利技术实施例，具有如下有益效果：本专利技术实施例提供的追踪光源点机器人的实验装置，包括图片信号采集装置和小车驱动装置。图片信号采集装置用于采集外部图片数据，并将图片数据发送给数据处理控制器。数据处理控制器用于根据图片数据，生成PWM驱动信号，并将PWM驱动信号发送给电机驱动模块，以使电机驱动模块调节小车驱动装置的行进速度，实现光源点的自动追踪。相比于现有技术没有很好的引导学习方案，本专利技术技术方案由简单的追踪光源点实验来引导学生学习图像识别技术和电机驱动技术，使得学生学习和认识更加直观，提高学生的学习兴趣和主观能动性。附图说明图1是本专利技术提供的追踪光源点机器人的实验装置的一种实施例的结构示意图；图2是本专利技术提供的数据处理控制器的一种实施例的结构示意图；图3是本专利技术提供的供电模块的一种实施例的结构示意图；图4是本专利技术提供的图片传感器的一种实施例的结构示意图；图5是本专利技术提供的电机驱动模块的一种实施例的结构示意图。具体实施方式下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。参见图1，是本专利技术提供的追踪光源点机器人的实验装置的一种实施例的结构示意图，如图1所示，该实验装置包括：图片信号采集装置1和小车驱动装置2。小车驱动装置2包括：电机驱动模块21、数据处理控制器22和供电模块23。数据处理控制器22分别与图片信号采集装置1、电机驱动模块21、供电模块23连接。供电模块23分别与图片信号采集装置1、电机驱动模块21连接。图片信号采集装置1用于采集外部图片数据，并将图片数据发送给数据处理控制器22。数据处理控制器22用于根据图片数据，生成PWM驱动信号，并将PWM驱动信号发送给电机驱动模块，以使电机驱动模块调节小车驱动装置的行进速度，实现光源点的自动追踪。在本实施例中，数据处理控制器用于根据图片数据，生成PWM驱动信号，具体为：步骤1：根据预设的颜色参数、图片矩形尺寸、横向PID速度比值和纵向PID速度比值，建立内部直角坐标系。步骤2：根据图片数据中的颜色，生成图片矩阵，并将图片矩阵与内部直角坐标系进行对比，获得横轴与纵轴的偏差值。步骤3：根据横轴与纵轴的偏差值，结合PID运算，计算得出横轴与纵轴的输出值。步骤4：将横轴输出值乘以横轴PID速度比值定义为横向转弯速度，将纵轴输出值乘以纵轴PID速度比值定义为纵向进退速度。步骤5：根据横向转弯速度和纵向进退速度，生成PWM驱动信号。在本实施例中，数据处理控制22需先进行内部程序初始化，设置对应扫描颜色与坐标值green_threshold、图片矩形尺寸size_threshold、横向PID速度比值x_pid和纵向PID速度比值h_pid，并以此建立内部直角坐标系。然后从采集的图片数据中捕获颜色，生成图片矩阵，利用图片矩阵中的点与直角坐标系中的点进行对比，得到横轴与纵轴的偏差值x_error和h_error；根据横轴与纵轴的偏差值，结合PID运算，计算得出横轴与纵轴的输出值x_output和h_output，即通过每一机器周期(1微秒)的PID运算。那么，将横轴输出值乘以横轴PID速度比值定义为横向转弯速度(x_output*x_pid)，将纵轴输出值乘以纵轴PID速度比值定义为纵向进退速度(h_output*h_pid)，由此可以得出-h_output-x_output的值就为左轮速度，h_output+x_output为右轮速度，最后以此生成左右轮的PWM驱动信号，发送给驱动电机模块。驱动电机模块接收到该信号后，对电机进行PWM调速。在本实施例中，如果横轴与纵轴的偏差值x_error和h_error均无变化，说明并无捕捉到光源，设备处于待机状态。如果发生变化说明捕捉到光源，则重复上述步骤，实现自动追踪。在本实施例中，所述图片信号采集装置为图片传感器。图片传感器是型号为OV7725的图片传感器。参见图4，图4是本专利技术提供的图片传感器的一种实施例的结构示意图。在本实施例中，数据处理控制器22是型号为STM32F765VGT6的处理器。参见图2，图2是本专利技术提供的数据处理控制器的一种实施例的结构示意图。在本实施例中，电机驱动模块21是型号为TB6612FNG的电机驱动模块。参见图5，图5是本专利技术提供的电机驱动模块的一种实施例的结构示意图。在本实施例中，供电模块23是型号为BD331A的芯片。参见图3，图3是本专利技术提供的供电模块的一种实施例的结构示意图。由上可见，本专利技术实施例提供的追踪光源点本文档来自技高网...

【技术保护点】
一种追踪光源点机器人的实验装置，其特征在于，包括：图片信号采集装置和小车驱动装置；所述小车驱动装置包括：电机驱动模块、数据处理控制器和供电模块；所述数据处理控制器分别与所述图片信号采集装置、电机驱动模块、供电模块连接；所述供电模块分别与所述图片信号采集装置、电机驱动模块连接；所述图片信号采集装置用于采集外部图片数据，并将所述图片数据发送给所述数据处理控制器；所述数据处理控制器用于根据所述图片数据，生成PWM驱动信号，并将所述PWM驱动信号发送给电机驱动模块，以使所述电机驱动模块调节所述小车驱动装置的行进速度，实现光源点的自动追踪。

【技术特征摘要】
1.一种追踪光源点机器人的实验装置，其特征在于，包括：图片信号采集装置和小车驱动装置；所述小车驱动装置包括：电机驱动模块、数据处理控制器和供电模块；所述数据处理控制器分别与所述图片信号采集装置、电机驱动模块、供电模块连接；所述供电模块分别与所述图片信号采集装置、电机驱动模块连接；所述图片信号采集装置用于采集外部图片数据，并将所述图片数据发送给所述数据处理控制器；所述数据处理控制器用于根据所述图片数据，生成PWM驱动信号，并将所述PWM驱动信号发送给电机驱动模块，以使所述电机驱动模块调节所述小车驱动装置的行进速度，实现光源点的自动追踪。2.根据权利要求1所述的追踪光源点机器人的实验装置，其特征在于，所述数据处理控制器用于根据所述图片数据，生成PWM驱动信号，具体为：根据预设的颜色参数、图片矩形尺寸、横向PID速度比值和纵向PID速度比值，建立内部直角坐标系；根据所述图片数据中的...

【专利技术属性】
技术研发人员：缪文南，周锐减，石捷，梁文坤，
申请(专利权)人：华南理工大学广州学院，
类型：发明
国别省市：广东,44