CN106383519A - 一种机器人自主定位充电系统及方法 - Google Patents
一种机器人自主定位充电系统及方法 Download PDFInfo
- Publication number
- CN106383519A CN106383519A CN201611013284.3A CN201611013284A CN106383519A CN 106383519 A CN106383519 A CN 106383519A CN 201611013284 A CN201611013284 A CN 201611013284A CN 106383519 A CN106383519 A CN 106383519A
- Authority
- CN
- China
- Prior art keywords
- robot
- microcontroller
- service end
- charging
- coordinate
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 57
- 238000004891 communication Methods 0.000 claims abstract description 50
- 238000003780 insertion Methods 0.000 claims abstract description 11
- 230000037431 insertion Effects 0.000 claims abstract description 11
- 230000005540 biological transmission Effects 0.000 claims abstract description 7
- 230000008569 process Effects 0.000 claims description 34
- 230000004807 localization Effects 0.000 claims description 28
- 230000005358 geomagnetic field Effects 0.000 claims description 22
- 230000000630 rising effect Effects 0.000 claims description 18
- 230000005611 electricity Effects 0.000 claims description 16
- 230000033001 locomotion Effects 0.000 claims description 15
- 238000012545 processing Methods 0.000 claims description 15
- 238000012546 transfer Methods 0.000 claims description 12
- 238000006243 chemical reaction Methods 0.000 claims description 9
- 238000003032 molecular docking Methods 0.000 claims description 9
- 238000001514 detection method Methods 0.000 claims description 7
- 230000008859 change Effects 0.000 claims description 4
- 230000005389 magnetism Effects 0.000 claims description 3
- 230000003287 optical effect Effects 0.000 claims description 3
- 238000011897 real-time detection Methods 0.000 claims description 3
- 239000000126 substance Substances 0.000 claims description 2
- 238000007689 inspection Methods 0.000 claims 1
- 230000000694 effects Effects 0.000 abstract description 6
- 239000004973 liquid crystal related substance Substances 0.000 abstract 1
- 238000013461 design Methods 0.000 description 9
- 238000011160 research Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000004888 barrier function Effects 0.000 description 2
- 239000003245 coal Substances 0.000 description 2
- 238000004880 explosion Methods 0.000 description 2
- 230000007774 longterm Effects 0.000 description 2
- 230000009467 reduction Effects 0.000 description 2
- 241000270708 Testudinidae Species 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 230000009194 climbing Effects 0.000 description 1
- 239000002817 coal dust Substances 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 238000010408 sweeping Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0225—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving docking at a fixed facility, e.g. base station or loading bay
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Acoustics & Sound (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种机器人自主定位充电系统及方法,其系统包括远程服务端、激光引导式充电桩和机器人充电控制电路,远程服务端包括服务端微控制器、服务端无线通信模块、触摸式液晶显示屏、服务端地磁场传感器和激光发射驱动电路;激光引导式充电桩包括底座、电源插入挡板、激光发射器和充电接口;机器人充电控制电路包括机器人微控制器、机载无线通信模块、摄像头、超声波传感器、机载地磁场传感器、电池电量检测电路、激光接收器和充电插头;其方法包括步骤:一、远程地磁场导航定位,二、近程摄像头定位,三、激光引导定位。本发明对地形的容忍度较大,能够快速有效地给机器人电池进行充电,工作可靠性高,实用性强,使用效果好,便于推广使用。
Description
技术领域
本发明属于机器人技术领域,具体涉及一种机器人自主定位充电系统及方法。
背景技术
随着移动机器人技术不断的发展,自主移动机器人由于其良好的智能性、自主性已成为了机器人研究领域的热点之一,被赋予了多种多样的任务,如今自主机器人已经被广泛的应用到了各个行业,如清扫机器人、引导机器人、运输机器人、水下无缆机器人、双臂协调控制机器人、爬壁机器人、管道机器人等。尽管机器人的功能在不断地扩展,应用也越来越广泛,但是所有的这一切都离不开电能的支持。随着机器人功能的不断扩展,机器人对电能的要求量也不断的增加,如何实现长时间的、有效的供电成为了机器人产业化必须面对和解决的问题,自主充电技术是解决机器人自主性的关键。
目前,移动机器人都是使用高质量的机载可充电蓄电池组来给自身供电,但是一般只能维持几个小时,一旦电能耗尽,必须采用人工干预的方式来给机器人充电。如果采用人工充电,那么机器人就处于一种非连续的任务环,这阻碍了机器人的长期自治。如果要实现真正意义上的长期自治,机器人必须能在所处的环境中实现自我支持,实现连续任务环。机器人连续任务环被简单地定义为使机器人以自主充电的方式来继续完成它所分配到的任务。一旦开始运行,机器人便进入连续任务环,即不再需要人的帮助,在此系统中,启动和停止是由机器人自动完成的。对于煤矿井下自主移动机器人来说,煤矿井下发生瓦斯、煤尘等爆炸事故后,如果存在着火点,容易发生二次爆炸等事故,人员进入具有高危险性,抢险人员在第一时间难以进入,而井上专家和决策者又急需获得井下情况,以便做出判断和决策。由机器人先行进入井下,探测井下事故破坏和环境情况,以声像和数据的形式将信息反馈到控制中心无疑是最有效而且安全的方案。由于常见的移动机器人动力能源的无缆化主要依赖高品质的机载蓄电池组,如何让机器人在无人工干预环境下安全可靠、快速高效地实现自动充电是实现机器人长期自治的一项关键技术。
为了解决机器人自主充电的问题,国内外进行了如下研究:机器人自主充电技术始于20世纪40年,在国外,Grey Walter在20世纪40年末成功研发了一台能自主充电的移动机器人名“Tortoises”,这种机器人具有在神经学研究中向着光线行走的行为。GreyWalter设计了一个充电站,他在充电站内部放置了一个光源和充电器,机器人采用跟踪光源的方法来寻找充电站。Grey Walter首先通过光束引导机器人靠近充电装置,然后将机器人本体上的充电臂插入就近的插座为机器人充电。1998年,TSukuba大学研制出一款名为Yamabico-Liv的移动机器人,此机器人在室内环境不变的情况下,通过使用导航系统,利用已知环境地图引导机器人到达充电站,然后驱动机器人配备的特别设备与充电站进行对接,实现机器人自主充电的目的。跟据已知环境地图进行自主充电存在一个缺点,一旦环境地图受到破坏,机器人将失去寻找目标,使用已知地图进行导航,限制了移动机器人的灵活性。1999年,卡内基·梅隆大学的机器人研究所开发了一种自主导游机器人Sage,Sage机器人的本体是采用改良Nomad XR4000移动机器人,利用CCD摄像机和三维路标引导机器人实现充电。加利福尼亚大学使用Nomad XR4000移动机器人,通过在充电站的上方设置色块和IR二极管来引导机器人对接以及监控充电状况。卡内基·梅隆大学和加利福尼亚大学采用了视觉系统和信标对充电目标进行定位。卡内基·梅隆大学采用三维路标引导机器人充电,三维路标具有很好的定位效果,但是在近距离对接时,CCD摄像机的精度将影响对接效果。加利福尼亚大学设计的充电装置采用漏斗状的对接窗口增加了机器人对接误差,提高了容忍度,但是漏斗状的对接窗口只能沿着一个支点左右偏转,限制了对接窗口的水平移动。因此,机器人与充电装置对接时,充电插针必须对正窗口的支点。
在国内,哈尔滨工业大学于2005年用Pioneer3DX轮式机器人在室内未知环境中进行了自主充电技术研究,使用激光传感器、PTZ彩色摄像机和里程计来引导机器人进行自主充电。2010年,重庆大学对室内清洁机器人进行了自主充电的研究,提出了以返回固定充电座充电为目标的自主返回路径规划策略。哈尔滨工业大学直接对室内墙壁上的插座进行对接,并没有进行充电装置设计。电源插座的对接容忍度过小,容易导致充电失败。
综上所述,目前机器人自主充电技术还存在很多缺点,如导航定位精度不够理想、容错及纠错能力不够强壮,充电装置的设计从结构上还不能为自动充电系统提供足够大的容忍度,缺乏普遍环境适应性,且在结构设计合理性、科学、经济等方面还不够理想,这些机器人自主充电技术问题急需我们去解决。
发明内容
本发明所要解决的技术问题在于针对上述现有技术中的不足,提供一种结构简单、设计合理、实现方便且成本低、使用方便、对地形的容忍度较大、能够快速有效地给机器人电池进行充电、工作可靠性高、实用性强的机器人自主定位充电系统。
为解决上述技术问题,本发明采用的技术方案是:一种机器人自主定位充电系统,其特征在于:包括远程服务端、激光引导式充电桩和机器人充电控制电路,所述远程服务端包括服务端微控制器、与市电连接并用于将市电转换为机器人充电所需电压的直流电压源和与直流电压源连接并用于为远程服务端各用电单元供电的电压转换电路,以及与服务端微控制器相接的服务端无线通信模块和触摸式液晶显示屏,所述服务端微控制器的输入端接有服务端地磁场传感器,所述服务端微控制器的输出端接有激光发射驱动电路;所述激光引导式充电桩包括底座以及转动连接在底座上且相啮合的第一齿轮和第二齿轮,所述底座上通过舵机支架固定连接有位于第一齿轮上方的舵机,所述第一齿轮与舵机的输出轴固定连接,所述第二齿轮上固定连接有电源插入挡板,所述电源插入挡板的下部固定连接有激光发射器,所述电源插入挡板的上部固定连接有充电接口,所述充电接口与直流电压源的输出端连接,所述舵机与服务端微控制器的输出端连接,所述激光发射器与激光发射驱动电路的输出端连接;所述机器人充电控制电路包括机器人微控制器和与机器人微控制器相接且用于与服务端无线通信模块无线连接并通信的机载无线通信模块;所述机器人微控制器的输入端接有摄像头、超声波传感器、机载地磁场传感器、用于检测机器人供电电池的电量的电池电量检测电路和用于接收激光发射器发射的激光信号的激光接收器,所述机器人微控制器的输出端接有用于驱动机器人行走电机的电机驱动器和用于为机器人供电电池充电的电池充电电路,所述电池充电电路上连接有用于连接到充电接口上的充电插头。
上述的一种机器人自主定位充电系统,其特征在于:所述服务端微控制器为单片机MSP430F169。
上述的一种机器人自主定位充电系统,其特征在于:所述激光发射驱动电路包括三极管Q1,所述三极管Q1的基极通过电阻R1与所述单片机MSP430F169的P4.4引脚连接,所述激光发射器的电源正极与+3.3V电源的输出端连接,所述激光发射器的电源负极与三极管Q1的集电极相接,所述三极管Q1的发射极接地。
上述的一种机器人自主定位充电系统,其特征在于:所述服务端无线通信模块和机载无线通信模块均为ZigBee无线通信模块。
上述的一种机器人自主定位充电系统,其特征在于:所述底座上固定连接有第一转动轴和第二转动轴,所述第一齿轮的几何中心位置处固定连接有第一圆柱滚子轴承,所述第一齿轮通过将第一转动轴安装到第一圆柱滚子轴承中的方式转动连接在底座上,所述第二齿轮的几何中心位置处固定连接有第二圆柱滚子轴承,所述第二齿轮通过将第二转动轴安装到第二圆柱滚子轴承中的方式转动连接在底座上。
上述的一种机器人自主定位充电系统,其特征在于:所述底座上安装有对称位于第一齿轮两侧且用于保护第一齿轮的两块第一保护挡板和对称位于第二齿轮两侧且用于保护第二齿轮的两块第二保护挡板;所述舵机支架由两个分别位于舵机两侧的门字型支架组成,所述舵机通过六角螺栓和六角螺母与门字型支架固定连接;所述电源插入挡板通过三角形固定件固定连接在第二齿轮上。
上述的一种机器人自主定位充电系统,其特征在于:所述机器人微控制器为DSP数字信号处理器。
上述的一种机器人自主定位充电系统,其特征在于:所述服务端地磁场传感器和机载地磁场传感器均为型号为HMC5883L的三轴地磁场传感器。
本发明还公开了一种方法步骤简单、设计合理、实现方便、定位效率高的机器人自主定位充电方法,其特征在于,该方法包括以下步骤:
步骤一、远程地磁场导航定位,其具体过程为:
步骤101、电池电量检测电路对机器人供电电池的电量进行实时检测并将检测到的信号实时输出给机器人微控制器,机器人微控制器将其接收到的机器人供电电池的电量与预先设定的低电量阈值进行比对,当机器人供电电池的电量小于低电量阈值时,判断为机器人供电电池的电量不足,此时,机器人微控制器通过机载无线通信模块向远程服务端发送充电开始指令;
步骤102、当远程服务端的服务端微控制器通过服务端无线通信模块接收到机器人微控制器发送的充电开始指令后,开始采集服务端地磁场传感器检测到的地磁数据,并通过服务端无线通信模块发送给机器人充电控制电路;
步骤103、机器人微控制器通过机载无线通信模块接收服务端微控制器发送的地磁数据,并采集机载地磁场传感器检测到的地磁数据,并将采集到的地磁数据与其接收到的地磁数据进行比对;
步骤104、机器人微控制器通过电机驱动器驱动机器人行走电机带动机器人原地顺时针旋转,一边旋转一边分析地磁数据的比对结果,找出一个方向,使得此方向上的地磁数据变化向其接收到的地磁数据靠拢,再直线移动;直线移动过程中,机器人微控制器采集超声波传感器检测到的距离信号,并根据距离信号判断前方是否有障碍物,当发现前方有障碍物信号时,左转或者右转至前方空旷地带继续直线移动;
步骤二、近程摄像头定位,其具体过程为:机器人按照步骤104进行移动的过程中,机器人微控制器采集摄像头拍摄到的图像,并调用图像光源识别处理模块,对摄像头拍摄到的图像进行分析处理,判断摄像头拍摄到的图像中能否获取到激光发射器发射的光,当摄像头拍摄到的图像中不能获取到激光发射器发射的光时,重复执行步骤104;当摄像头拍摄到的图像中能够获取到激光发射器发射的光时,保持此时机器人的位置,并判断为此时的充电插头面向了充电接口,执行步骤三;
步骤三、激光引导定位,其具体过程为:
步骤301、机器人微控制器通过机载无线通信模块向远程服务端发送激光引导定位开始指令;
步骤302、当远程服务端的服务端微控制器通过服务端无线通信模块接收到机器人微控制器发送的激光引导定位开始指令后,通过激光发射驱动电路驱动激光发射器发射激光,并产生周期为50Hz,脉宽为0.5ms的方波,使舵机复位;
步骤303、机器人微控制器产生的方波脉宽由0.5ms向2.5ms、每50ms增加0.01ms的速度递增,递增至2.5ms时,再按照每50ms减小0.01ms的速度,递减至0.5ms,不断重复,每一次增加或减少完成,均等待20ms,驱动舵机转动,舵机转动时带动第一齿轮转动,第一齿轮再带动第二齿轮转动,第二齿轮再带动电源插入挡板转动,进行激光引导定位,直至激光接收器接收到激光发射器发射的激光信号;
步骤304、机器人微控制器通过机载无线通信模块向远程服务端发送接收到激光信号指令;
步骤305、当远程服务端的服务端微控制器通过服务端无线通信模块接收到机器人微控制器发送的激光引导定位完成指令后,服务端微控制器控制舵机保持当前脉宽的方波,使得舵机保持相应的转角不动,并向机器人充电控制电路发送激光引导定位完成指令;
步骤306、机器人微控制器通过机载无线通信模块接收服务端微控制器发送的激光引导定位完成指令后,通过电机驱动器驱动机器人行走电机带动机器人直线移动,直线移动过程中,机器人微控制器采集超声波传感器检测到的距离信号,并根据距离信号向靠近电源插入挡板的位置移动,直到充电插头与充电接口对接后,机器人停止运动,并开始充电。
上述的方法,其特征在于:步骤二中机器人微控制器调用图像光源识别处理模块,对摄像头拍摄到的图像进行分析处理,判断摄像头拍摄到的图像中能否获取到激光发射器发射的光的具体过程为:
步骤201、机器人微控制器调用灰度图处理模块将摄像头拍摄到的图像转化成灰度图;
步骤202、机器人微控制器调用图像二值化处理模块将步骤201处理得到的灰度图转化为二值化图像,使摄像头拍摄到的图像中的光源信息为黑色像素,其它部分为白色像素;
步骤203、定义步骤202处理得到的图像左下角第一个像素点的坐标为(1,1),定义Fxi为由坐标为(i,1)的点和坐标为(i,n)的点连成的线段上黑色像素点的个数,定义Fyj为由坐标为(1,j)的点和坐标为(m,j)的点连成的线段上黑色像素点的个数;其中,m为摄像头拍摄到的一帧图像的像素长度,1≤i≤m;n为摄像头拍摄到的一帧图像的像素高度,1≤j≤n;
步骤204、光源中心点的横坐标的确定,具体过程为:
步骤2041、设Fi为从坐标(i,1)到(i,n)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数,定义F1=1,将由坐标为(i,1)的点和坐标为(i,n)的点连成的线段分为m个阶段,定义于阶段k取得的Fi的值为前k-1个阶段取得的Fi的值的最优值判断,建立Fi的动态转移方程:
步骤2042、机器人微控制器根据公式ci=Fi/m计算得到横向坐标权值因子ci;
步骤2043、定义fi为从坐标(i,1)到(i,n)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数经过加权处理后的权值,定义将由坐标为(i,1)的点和坐标为(i,n)的点连成的线段分为m个阶段,定义于阶段k取得的数组Fi的值为前k-1个阶段取得的数组Fi的值的最优值判断,建立fi的动态转移方程:
步骤2044、机器人微控制器根据公式numx=max{f1,f2,...,fm}计算得到为从坐标(i,1)到(i,n)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数经过加权处理后的权值的最大值numx,并将numx对应的坐标的横坐标确定为光源中心点的横坐标,将光源中心点的横坐标记为numbx;
步骤205、光源中心点的纵坐标的确定,具体过程为:
步骤2051、设Wj为从坐标(1,j)到(m,j)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数,定义W1=1,将由坐标为(1,j)的点和坐标为(m,j)的点连成的线段分为n个阶段,定义于阶段k取得的Wj的值为前k-1个阶段取得的Wj的值的最优值判断,建立Wj的动态转移方程:
步骤2052、机器人微控制器根据公式lj=Fj/n计算得到纵向坐标权值因子lj;
步骤2053、定义wj为从坐标(1,j)到(m,j)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数经过加权处理后的权值,定义将由坐标为(1,j)的点和坐标为(m,j)的点连成的线段分为n个阶段,定义于阶段k取得的Wj的值为前k-1个阶段取得的Wj的值的最优值判断,建立wj的动态转移方程:
步骤2054、机器人微控制器根据公式numy=max{w1,w2,...,wn}计算得到为从坐标(1,j)到(m,j)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数经过加权处理后的权值的最大值numy,并将numy对应的坐标的纵坐标确定为光源中心点的纵坐标,将光源中心点的纵坐标记为numby;
步骤206、机器人微控制器根据条件判断摄像头拍摄到的图像中能否获取到激光发射器发射的光,当条件成立时,判断为摄像头拍摄到的图像中能够获取到激光发射器发射的光;否则,当条件不成立时,判断为摄像头拍摄到的图像中不能够获取到激光发射器发射的光。
本发明与现有技术相比具有以下优点:
1、本发明的机器人自主定位充电系统的结构简单,设计合理,实现方便且成本低。
2、本发明机器人自主定位充电系统的使用方便,能够放置在比较复杂的地形中使用,对地形的容忍度较大。
3、本发明机器人自主定位充电方法的方法步骤简单,设计合理,实现方便,定位效率高。
4、本发明采用了远程地磁场导航定位、近程摄像头定位和激光引导定位三种定位方式结合的定位方法,在机器人电量即将不足时,能够快速有效地给机器人电池进行充电,工作可靠性高。
5、本发明的实用性强,使用效果好,便于推广使用。
综上所述,本发明设计合理,实现方便且成本低,使用方便,对地形的容忍度较大,能够快速有效地给机器人电池进行充电,工作可靠性高,实用性强,使用效果好,便于推广使用。
下面通过附图和实施例,对本发明的技术方案做进一步的详细描述。
附图说明
图1为本发明机器人自主定位充电系统的电路原理框图。
图2为本发明激光引导式充电桩的结构示意图。
图3为本发明激光发射驱动电路的电路原理图。
图4为本发明机器人自主定位充电方法的方法流程框图。
附图标记说明:
1—远程服务端; 1-1—服务端微控制器;1-2—直流电压源;
1-3—服务端无线通信模块;1-4—触摸式液晶显示屏;
1-5—服务端地磁场传感器; 1-6—激光发射驱动电路;
1-7—电压转换电路; 2—激光引导式充电桩;2-1—底座;
2-2—充电接口; 2-3—第一齿轮; 2-4—第二齿轮;
2-5—门字型支架; 2-6—舵机; 2-7—电源插入挡板;
2-8—激光发射器;2-9—第一保护挡板; 2-10—第二保护挡板;
2-11—六角螺栓; 2-12—六角螺母; 2-13—三角形固定件;
3—机器人充电控制电路; 3-1—机器人微控制器;
3-2—机载无线通信模块; 3-3—摄像头; 3-4—超声波传感器;
3-5—机载地磁场传感器; 3-6—电池电量检测电路;
3-7—激光接收器; 3-8—电机驱动器; 3-9—电池充电电路;
3-10—充电插头。
具体实施方式
如图1和图2所示,本发明的一种机器人自主定位充电系统,包括远程服务端1、激光引导式充电桩2和机器人充电控制电路3,所述远程服务端1包括服务端微控制器1-1、与市电连接并用于将市电转换为机器人充电所需电压的直流电压源1-2和与直流电压源1-2连接并用于为远程服务端1各用电单元供电的电压转换电路1-7,以及与服务端微控制器1-1相接的服务端无线通信模块1-3和触摸式液晶显示屏1-4,所述服务端微控制器1-1的输入端接有服务端地磁场传感器1-5,所述服务端微控制器1-1的输出端接有激光发射驱动电路1-6;所述激光引导式充电桩2包括底座2-1以及转动连接在底座2-1上且相啮合的第一齿轮2-3和第二齿轮2-4,所述底座2-1上通过舵机支架固定连接有位于第一齿轮2-3上方的舵机2-6,所述第一齿轮2-3与舵机2-6的输出轴固定连接,所述第二齿轮2-4上固定连接有电源插入挡板2-7,所述电源插入挡板2-7的下部固定连接有激光发射器2-8,所述电源插入挡板2-7的上部固定连接有充电接口2-2,所述充电接口2-2与直流电压源1-2的输出端连接,所述舵机2-6与服务端微控制器1-1的输出端连接,所述激光发射器2-8与激光发射驱动电路1-6的输出端连接;所述机器人充电控制电路3包括机器人微控制器3-1和与机器人微控制器3-1相接且用于与服务端无线通信模块1-3无线连接并通信的机载无线通信模块3-2;所述机器人微控制器3-1的输入端接有摄像头3-3、超声波传感器3-4、机载地磁场传感器3-5、用于检测机器人供电电池的电量的电池电量检测电路3-6和用于接收激光发射器2-8发射的激光信号的激光接收器3-7,所述机器人微控制器3-1的输出端接有用于驱动机器人行走电机的电机驱动器3-8和用于为机器人供电电池充电的电池充电电路3-9,所述电池充电电路3-9上连接有用于连接到充电接口2-2上的充电插头3-10。
本实施例中,所述服务端微控制器1-1为单片机MSP430F169。
本实施例中,如图3所示,所述激光发射驱动电路1-6包括三极管Q1,所述三极管Q1的基极通过电阻R1与所述单片机MSP430F169的P4.4引脚连接,所述激光发射器2-8的电源正极与+3.3V电源的输出端连接,所述激光发射器2-8的电源负极与三极管Q1的集电极相接,所述三极管Q1的发射极接地。
本实施例中,所述服务端无线通信模块1-3和机载无线通信模块3-2均为ZigBee无线通信模块。具体实施时,所述ZigBee无线通信模块为型号为CC2530的ZigBee无线通信模块。
本实施例中,如图2所示,所述底座2-1上固定连接有第一转动轴和第二转动轴,所述第一齿轮2-3的几何中心位置处固定连接有第一圆柱滚子轴承,所述第一齿轮2-3通过将第一转动轴安装到第一圆柱滚子轴承中的方式转动连接在底座2-1上,所述第二齿轮2-4的几何中心位置处固定连接有第二圆柱滚子轴承,所述第二齿轮2-4通过将第二转动轴安装到第二圆柱滚子轴承中的方式转动连接在底座2-1上。
本实施例中,如图2所示,所述底座2-1上安装有对称位于第一齿轮2-3两侧且用于保护第一齿轮2-3的两块第一保护挡板2-9和对称位于第二齿轮2-4两侧且用于保护第二齿轮2-4的两块第二保护挡板2-10;所述舵机支架由两个分别位于舵机2-6两侧的门字型支架2-5组成,所述舵机2-6通过六角螺栓2-11和六角螺母2-12与门字型支架2-5固定连接;所述电源插入挡板2-7通过三角形固定件2-13固定连接在第二齿轮2-4上。具体实施时,所述第一齿轮2-3和第二齿轮2-4的齿数比为1:1。
本实施例中,所述机器人微控制器3-1为DSP数字信号处理器。
本实施例中,所述服务端地磁场传感器1-5和机载地磁场传感器3-5均为型号为HMC5883L的三轴地磁场传感器。
具体实施时,所述激光发射器2-8为一字线激光发射器,与充电接口2-2的旋转摆动相配合,提高了机器人上的充电插头3-10与充电接口2-2的对接成功率,有效避免了无法对接的问题。
如图4所示,本发明的机器人自主定位充电的方法,包括以下步骤:
步骤一、远程地磁场导航定位,其具体过程为:
步骤101、电池电量检测电路3-6对机器人供电电池的电量进行实时检测并将检测到的信号实时输出给机器人微控制器3-1,机器人微控制器3-1将其接收到的机器人供电电池的电量与预先设定的低电量阈值进行比对,当机器人供电电池的电量小于低电量阈值时,判断为机器人供电电池的电量不足,此时,机器人微控制器3-1通过机载无线通信模块3-2向远程服务端1发送充电开始指令;具体实施时,所述充电开始指令定义为字符串“BEGIN1”;
步骤102、当远程服务端1的服务端微控制器1-1通过服务端无线通信模块1-3接收到机器人微控制器3-1发送的充电开始指令后,开始采集服务端地磁场传感器1-5检测到的地磁数据,并通过服务端无线通信模块1-3发送给机器人充电控制电路3;
步骤103、机器人微控制器3-1通过机载无线通信模块3-2接收服务端微控制器1-1发送的地磁数据,并采集机载地磁场传感器3-5检测到的地磁数据,并将采集到的地磁数据与其接收到的地磁数据进行比对;
步骤104、机器人微控制器3-1通过电机驱动器3-8驱动机器人行走电机带动机器人原地顺时针旋转,一边旋转一边分析地磁数据的比对结果,找出一个方向,使得此方向上的地磁数据变化向其接收到的地磁数据靠拢,再直线移动;直线移动过程中,机器人微控制器3-1采集超声波传感器3-4检测到的距离信号,并根据距离信号判断前方是否有障碍物,当发现前方有障碍物信号时,左转或者右转至前方空旷地带继续直线移动;
步骤二、近程摄像头定位,其具体过程为:机器人按照步骤104进行移动的过程中,机器人微控制器3-1采集摄像头3-3拍摄到的图像,并调用图像光源识别处理模块,对摄像头3-3拍摄到的图像进行分析处理,判断摄像头3-3拍摄到的图像中能否获取到激光发射器2-8发射的光,当摄像头3-3拍摄到的图像中不能获取到激光发射器2-8发射的光时,重复执行步骤104;当摄像头3-3拍摄到的图像中能够获取到激光发射器2-8发射的光时,保持此时机器人的位置,并判断为此时的充电插头3-10面向了充电接口2-2,执行步骤三;
步骤三、激光引导定位,其具体过程为:
步骤301、机器人微控制器3-1通过机载无线通信模块3-2向远程服务端1发送激光引导定位开始指令;具体实施时,所述激光引导定位开始指令定义为字符串“BEGIN2”;
步骤302、当远程服务端1的服务端微控制器1-1通过服务端无线通信模块1-3接收到机器人微控制器3-1发送的激光引导定位开始指令后,通过激光发射驱动电路1-6驱动激光发射器2-8发射激光,并产生周期为50Hz,脉宽为0.5ms的方波,使舵机2-6复位;
步骤303、机器人微控制器3-1产生的方波脉宽由0.5ms向2.5ms、每50ms增加0.01ms的速度递增,递增至2.5ms时,再按照每50ms减小0.01ms的速度,递减至0.5ms,不断重复,每一次增加或减少完成,均等待20ms,驱动舵机2-6转动,舵机2-6转动时带动第一齿轮2-3转动,第一齿轮2-3再带动第二齿轮2-4转动,第二齿轮2-4再带动电源插入挡板2-7转动,进行激光引导定位,直至激光接收器3-7接收到激光发射器2-8发射的激光信号;
步骤304、机器人微控制器3-1通过机载无线通信模块3-2向远程服务端1发送接收到激光信号指令;具体实施时,所述接收到激光信号指令定义为字符串“GETOVER”;
步骤305、当远程服务端1的服务端微控制器1-1通过服务端无线通信模块1-3接收到机器人微控制器3-1发送的激光引导定位完成指令后,服务端微控制器1-1控制舵机2-6保持当前脉宽的方波,使得舵机2-6保持相应的转角不动,并向机器人充电控制电路3发送激光引导定位完成指令;具体实施时,所述激光引导定位完成指令定义为字符串“OK”;
步骤306、机器人微控制器3-1通过机载无线通信模块3-2接收服务端微控制器1-1发送的激光引导定位完成指令后,通过电机驱动器3-8驱动机器人行走电机带动机器人直线移动,直线移动过程中,机器人微控制器3-1采集超声波传感器3-4检测到的距离信号,并根据距离信号向靠近电源插入挡板2-7的位置移动,直到充电插头3-10与充电接口2-2对接后,机器人停止运动,并开始充电。
本实施例中,步骤二中机器人微控制器3-1调用图像光源识别处理模块,对摄像头3-3拍摄到的图像进行分析处理,判断摄像头3-3拍摄到的图像中能否获取到激光发射器2-8发射的光的具体过程为:
步骤201、机器人微控制器3-1调用灰度图处理模块将摄像头3-3拍摄到的图像转化成灰度图;
步骤202、机器人微控制器3-1调用图像二值化处理模块将步骤201处理得到的灰度图转化为二值化图像,使摄像头3-3拍摄到的图像中的光源信息为黑色像素,其它部分为白色像素;
步骤203、定义步骤202处理得到的图像左下角第一个像素点的坐标为(1,1),定义Fxi为由坐标为(i,1)的点和坐标为(i,n)的点连成的线段上黑色像素点的个数,定义Fyj为由坐标为(1,j)的点和坐标为(m,j)的点连成的线段上黑色像素点的个数;其中,m为摄像头3-3拍摄到的一帧图像的像素长度,1≤i≤m;n为摄像头3-3拍摄到的一帧图像的像素高度,1≤j≤n;
步骤204、光源中心点的横坐标的确定,具体过程为:
步骤2041、设Fi为从坐标(i,1)到(i,n)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数,定义F1=1,将由坐标为(i,1)的点和坐标为(i,n)的点连成的线段分为m个阶段,定义于阶段k取得的Fi的值为前k-1个阶段取得的Fi的值的最优值判断,建立Fi的动态转移方程:
步骤2042、机器人微控制器3-1根据公式ci=Fi/m计算得到横向坐标权值因子ci;
步骤2043、定义fi为从坐标(i,1)到(i,n)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数经过加权处理后的权值,定义将由坐标为(i,1)的点和坐标为(i,n)的点连成的线段分为m个阶段,定义于阶段k取得的数组Fi的值为前k-1个阶段取得的数组Fi的值的最优值判断,建立fi的动态转移方程:
步骤2044、机器人微控制器3-1根据公式numx=max{f1,f2,...,fm}计算得到为从坐标(i,1)到(i,n)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数经过加权处理后的权值的最大值numx,并将numx对应的坐标的横坐标确定为光源中心点的横坐标,将光源中心点的横坐标记为numbx;用公式将numbx表示为:numbx=i(fi=numx);
步骤205、光源中心点的纵坐标的确定,具体过程为:
步骤2051、设Wj为从坐标(1,j)到(m,j)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数,定义W1=1,将由坐标为(1,j)的点和坐标为(m,j)的点连成的线段分为n个阶段,定义于阶段k取得的Wj的值为前k-1个阶段取得的Wj的值的最优值判断,建立Wj的动态转移方程:
步骤2052、机器人微控制器3-1根据公式lj=Fj/n计算得到纵向坐标权值因子lj;
步骤2053、定义wj为从坐标(1,j)到(m,j)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数经过加权处理后的权值,定义将由坐标为(1,j)的点和坐标为(m,j)的点连成的线段分为n个阶段,定义于阶段k取得的Wj的值为前k-1个阶段取得的Wj的值的最优值判断,建立wj的动态转移方程:
步骤2054、机器人微控制器3-1根据公式numy=max{w1,w2,...,wn}计算得到为从坐标(1,j)到(m,j)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数经过加权处理后的权值的最大值numy,并将numy对应的坐标的纵坐标确定为光源中心点的纵坐标,将光源中心点的纵坐标记为numby;用公式将numby表示为:numby=j(wj=numy);
步骤206、机器人微控制器3-1根据条件判断摄像头3-3拍摄到的图像中能否获取到激光发射器2-8发射的光,当条件成立时,判断为摄像头3-3拍摄到的图像中能够获取到激光发射器2-8发射的光;否则,当条件不成立时,判断为摄像头3-3拍摄到的图像中不能够获取到激光发射器2-8发射的光。
以上所述,仅是本发明的较佳实施例,并非对本发明作任何限制,凡是根据本发明技术实质对以上实施例所作的任何简单修改、变更以及等效结构变化,均仍属于本发明技术方案的保护范围内。
Claims (10)
1.一种机器人自主定位充电系统,其特征在于:包括远程服务端(1)、激光引导式充电桩(2)和机器人充电控制电路(3),所述远程服务端(1)包括服务端微控制器(1-1)、与市电连接并用于将市电转换为机器人充电所需电压的直流电压源(1-2)和与直流电压源(1-2)连接并用于为远程服务端(1)各用电单元供电的电压转换电路(1-7),以及与服务端微控制器(1-1)相接的服务端无线通信模块(1-3)和触摸式液晶显示屏(1-4),所述服务端微控制器(1-1)的输入端接有服务端地磁场传感器(1-5),所述服务端微控制器(1-1)的输出端接有激光发射驱动电路(1-6);所述激光引导式充电桩(2)包括底座(2-1)以及转动连接在底座(2-1)上且相啮合的第一齿轮(2-3)和第二齿轮(2-4),所述底座(2-1)上通过舵机支架固定连接有位于第一齿轮(2-3)上方的舵机(2-6),所述第一齿轮(2-3)与舵机(2-6)的输出轴固定连接,所述第二齿轮(2-4)上固定连接有电源插入挡板(2-7),所述电源插入挡板(2-7)的下部固定连接有激光发射器(2-8),所述电源插入挡板(2-7)的上部固定连接有充电接口(2-2),所述充电接口(2-2)与直流电压源(1-2)的输出端连接,所述舵机(2-6)与服务端微控制器(1-1)的输出端连接,所述激光发射器(2-8)与激光发射驱动电路(1-6)的输出端连接;所述机器人充电控制电路(3)包括机器人微控制器(3-1)和与机器人微控制器(3-1)相接且用于与服务端无线通信模块(1-3)无线连接并通信的机载无线通信模块(3-2);所述机器人微控制器(3-1)的输入端接有摄像头(3-3)、超声波传感器(3-4)、机载地磁场传感器(3-5)、用于检测机器人供电电池的电量的电池电量检测电路(3-6)和用于接收激光发射器(2-8)发射的激光信号的激光接收器(3-7),所述机器人微控制器(3-1)的输出端接有用于驱动机器人行走电机的电机驱动器(3-8)和用于为机器人供电电池充电的电池充电电路(3-9),所述电池充电电路(3-9)上连接有用于连接到充电接口(2-2)上的充电插头(3-10)。
2.按照权利要求1所述的一种机器人自主定位充电系统,其特征在于:所述服务端微控制器(1-1)为单片机MSP430F169。
3.按照权利要求2所述的一种机器人自主定位充电系统,其特征在于:所述激光发射驱动电路(1-6)包括三极管Q1,所述三极管Q1的基极通过电阻R1与所述单片机MSP430F169的P4.4引脚连接,所述激光发射器(2-8)的电源正极与+3.3V电源的输出端连接,所述激光发射器(2-8)的电源负极与三极管Q1的集电极相接,所述三极管Q1的发射极接地。
4.按照权利要求1所述的一种机器人自主定位充电系统,其特征在于:所述服务端无线通信模块(1-3)和机载无线通信模块(3-2)均为ZigBee无线通信模块。
5.按照权利要求1所述的一种机器人自主定位充电系统,其特征在于:所述底座(2-1)上固定连接有第一转动轴和第二转动轴,所述第一齿轮(2-3)的几何中心位置处固定连接有第一圆柱滚子轴承,所述第一齿轮(2-3)通过将第一转动轴安装到第一圆柱滚子轴承中的方式转动连接在底座(2-1)上,所述第二齿轮(2-4)的几何中心位置处固定连接有第二圆柱滚子轴承,所述第二齿轮(2-4)通过将第二转动轴安装到第二圆柱滚子轴承中的方式转动连接在底座(2-1)上。
6.按照权利要求1所述的一种机器人自主定位充电系统,其特征在于:所述底座(2-1)上安装有对称位于第一齿轮(2-3)两侧且用于保护第一齿轮(2-3)的两块第一保护挡板(2-9)和对称位于第二齿轮(2-4)两侧且用于保护第二齿轮(2-4)的两块第二保护挡板(2-10);所述舵机支架由两个分别位于舵机(2-6)两侧的门字型支架(2-5)组成,所述舵机(2-6)通过六角螺栓(2-11)和六角螺母(2-12)与门字型支架(2-5)固定连接;所述电源插入挡板(2-7)通过三角形固定件(2-13)固定连接在第二齿轮(2-4)上。
7.按照权利要求1所述的一种机器人自主定位充电系统,其特征在于:所述机器人微控制器(3-1)为DSP数字信号处理器。
8.按照权利要求1所述的一种机器人自主定位充电系统,其特征在于:所述服务端地磁场传感器(1-5)和机载地磁场传感器(3-5)均为型号为HMC5883L的三轴地磁场传感器。
9.一种利用如权利要求1所述的系统进行机器人自主定位充电的方法,其特征在于,该方法包括以下步骤:
步骤一、远程地磁场导航定位,其具体过程为:
步骤101、电池电量检测电路(3-6)对机器人供电电池的电量进行实时检测并将检测到的信号实时输出给机器人微控制器(3-1),机器人微控制器(3-1)将其接收到的机器人供电电池的电量与预先设定的低电量阈值进行比对,当机器人供电电池的电量小于低电量阈值时,判断为机器人供电电池的电量不足,此时,机器人微控制器(3-1)通过机载无线通信模块(3-2)向远程服务端(1)发送充电开始指令;
步骤102、当远程服务端(1)的服务端微控制器(1-1)通过服务端无线通信模块(1-3)接收到机器人微控制器(3-1)发送的充电开始指令后,开始采集服务端地磁场传感器(1-5)检测到的地磁数据,并通过服务端无线通信模块(1-3)发送给机器人充电控制电路(3);
步骤103、机器人微控制器(3-1)通过机载无线通信模块(3-2)接收服务端微控制器(1-1)发送的地磁数据,并采集机载地磁场传感器(3-5)检测到的地磁数据,并将采集到的地磁数据与其接收到的地磁数据进行比对;
步骤104、机器人微控制器(3-1)通过电机驱动器(3-8)驱动机器人行走电机带动机器人原地顺时针旋转,一边旋转一边分析地磁数据的比对结果,找出一个方向,使得此方向上的地磁数据变化向其接收到的地磁数据靠拢,再直线移动;直线移动过程中,机器人微控制器(3-1)采集超声波传感器(3-4)检测到的距离信号,并根据距离信号判断前方是否有障碍物,当发现前方有障碍物信号时,左转或者右转至前方空旷地带继续直线移动;
步骤二、近程摄像头定位,其具体过程为:机器人按照步骤104进行移动的过程中,机器人微控制器(3-1)采集摄像头(3-3)拍摄到的图像,并调用图像光源识别处理模块,对摄像头(3-3)拍摄到的图像进行分析处理,判断摄像头(3-3)拍摄到的图像中能否获取到激光发射器(2-8)发射的光,当摄像头(3-3)拍摄到的图像中不能获取到激光发射器(2-8)发射的光时,重复执行步骤104;当摄像头(3-3)拍摄到的图像中能够获取到激光发射器(2-8)发射的光时,保持此时机器人的位置,并判断为此时的充电插头(3-10)面向了充电接口(2-2),执行步骤三;
步骤三、激光引导定位,其具体过程为:
步骤301、机器人微控制器(3-1)通过机载无线通信模块(3-2)向远程服务端(1)发送激光引导定位开始指令;
步骤302、当远程服务端(1)的服务端微控制器(1-1)通过服务端无线通信模块(1-3)接收到机器人微控制器(3-1)发送的激光引导定位开始指令后,通过激光发射驱动电路(1-6)驱动激光发射器(2-8)发射激光,并产生周期为50Hz,脉宽为0.5ms的方波,使舵机(2-6)复位;
步骤303、机器人微控制器(3-1)产生的方波脉宽由0.5ms向2.5ms、每50ms增加0.01ms的速度递增,递增至2.5ms时,再按照每50ms减小0.01ms的速度,递减至0.5ms,不断重复,每一次增加或减少完成,均等待20ms,驱动舵机(2-6)转动,舵机(2-6)转动时带动第一齿轮(2-3)转动,第一齿轮(2-3)再带动第二齿轮(2-4)转动,第二齿轮(2-4)再带动电源插入挡板(2-7)转动,进行激光引导定位,直至激光接收器(3-7)接收到激光发射器(2-8)发射的激光信号;
步骤304、机器人微控制器(3-1)通过机载无线通信模块(3-2)向远程服务端(1)发送接收到激光信号指令;
步骤305、当远程服务端(1)的服务端微控制器(1-1)通过服务端无线通信模块(1-3)接收到机器人微控制器(3-1)发送的激光引导定位完成指令后,服务端微控制器(1-1)控制舵机(2-6)保持当前脉宽的方波,使得舵机(2-6)保持相应的转角不动,并向机器人充电控制电路(3)发送激光引导定位完成指令;
步骤306、机器人微控制器(3-1)通过机载无线通信模块(3-2)接收服务端微控制器(1-1)发送的激光引导定位完成指令后,通过电机驱动器(3-8)驱动机器人行走电机带动机器人直线移动,直线移动过程中,机器人微控制器(3-1)采集超声波传感器(3-4)检测到的距离信号,并根据距离信号向靠近电源插入挡板(2-7)的位置移动,直到充电插头(3-10)与充电接口(2-2)对接后,机器人停止运动,并开始充电。
10.按照权利要求9所述的方法,其特征在于:步骤二中机器人微控制器(3-1)调用图像光源识别处理模块,对摄像头(3-3)拍摄到的图像进行分析处理,判断摄像头(3-3)拍摄到的图像中能否获取到激光发射器(2-8)发射的光的具体过程为:
步骤201、机器人微控制器(3-1)调用灰度图处理模块将摄像头(3-3)拍摄到的图像转化成灰度图;
步骤202、机器人微控制器(3-1)调用图像二值化处理模块将步骤201处理得到的灰度图转化为二值化图像,使摄像头(3-3)拍摄到的图像中的光源信息为黑色像素,其它部分为白色像素;
步骤203、定义步骤202处理得到的图像左下角第一个像素点的坐标为(1,1),定义Fxi为由坐标为(i,1)的点和坐标为(i,n)的点连成的线段上黑色像素点的个数,定义Fyj为由坐标为(1,j)的点和坐标为(m,j)的点连成的线段上黑色像素点的个数;其中,m为摄像头(3-3)拍摄到的一帧图像的像素长度,1≤i≤m;n为摄像头(3-3)拍摄到的一帧图像的像素高度,1≤j≤n;
步骤204、光源中心点的横坐标的确定,具体过程为:
步骤2041、设Fi为从坐标(i,1)到(i,n)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数,定义F1=1,将由坐标为(i,1)的点和坐标为(i,n)的点连成的线段分为m个阶段,定义于阶段k取得的Fi的值为前k-1个阶段取得的Fi的值的最优值判断,建立Fi的动态转移方程:
步骤2042、机器人微控制器(3-1)根据公式ci=Fi/m计算得到横向坐标权值因子ci;
步骤2043、定义fi为从坐标(i,1)到(i,n)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数经过加权处理后的权值,定义将由坐标为(i,1)的点和坐标为(i,n)的点连成的线段分为m个阶段,定义于阶段k取得的数组Fi的值为前k-1个阶段取得的数组Fi的值的最优值判断,建立fi的动态转移方程:
步骤2044、机器人微控制器(3-1)根据公式numx=max{f1,f2,...,fm}计算得到为从坐标(i,1)到(i,n)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数经过加权处理后的权值的最大值numx,并将numx对应的坐标的横坐标确定为光源中心点的横坐标,将光源中心点的横坐标记为numbx;
步骤205、光源中心点的纵坐标的确定,具体过程为:
步骤2051、设Wj为从坐标(1,j)到(m,j)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数,定义W1=1,将由坐标为(1,j)的点和坐标为(m,j)的点连成的线段分为n个阶段,定义于阶段k取得的Wj的值为前k-1个阶段取得的Wj的值的最优值判断,建立Wj的动态转移方程:
步骤2052、机器人微控制器(3-1)根据公式lj=Fj/n计算得到纵向坐标权值因子lj;
步骤2053、定义wj为从坐标(1,j)到(m,j)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数经过加权处理后的权值,定义将由坐标为(1,j)的点和坐标为(m,j)的点连成的线段分为n个阶段,定义于阶段k取得的Wj的值为前k-1个阶段取得的Wj的值的最优值判断,建立wj的动态转移方程:
步骤2054、机器人微控制器(3-1)根据公式numy=max{w1,w2,...,wn}计算得到为从坐标(1,j)到(m,j)中,黑色元素的数量处于连续上升状态下最长连续上升的坐标的个数经过加权处理后的权值的最大值numy,并将numy对应的坐标的纵坐标确定为光源中心点的纵坐标,将光源中心点的纵坐标记为numby;
步骤206、机器人微控制器(3-1)根据条件判断摄像头(3-3)拍摄到的图像中能否获取到激光发射器(2-8)发射的光,当条件成立时,判断为摄像头(3-3)拍摄到的图像中能够获取到激光发射器(2-8)发射的光;否则,当条件不成立时,判断为摄像头(3-3)拍摄到的图像中不能够获取到激光发射器(2-8)发射的光。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611013284.3A CN106383519B (zh) | 2016-11-17 | 2016-11-17 | 一种机器人自主定位充电系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611013284.3A CN106383519B (zh) | 2016-11-17 | 2016-11-17 | 一种机器人自主定位充电系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106383519A true CN106383519A (zh) | 2017-02-08 |
CN106383519B CN106383519B (zh) | 2023-04-18 |
Family
ID=57958597
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611013284.3A Active CN106383519B (zh) | 2016-11-17 | 2016-11-17 | 一种机器人自主定位充电系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106383519B (zh) |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107600373A (zh) * | 2017-09-05 | 2018-01-19 | 武汉大学 | 一种微型仿生水下机器人自主导航返程充电方法及系统 |
CN108181904A (zh) * | 2017-12-29 | 2018-06-19 | 深圳市艾特智能科技有限公司 | 机器人避障方法、系统、可读存储介质及机器人 |
CN108390435A (zh) * | 2018-04-02 | 2018-08-10 | 广东欧珀移动通信有限公司 | 一种充电方法、系统及计算机可读存储介质 |
CN108508897A (zh) * | 2018-04-20 | 2018-09-07 | 杭州蓝芯科技有限公司 | 一种基于视觉的机器人自动充电对准系统及方法 |
CN108568660A (zh) * | 2017-03-10 | 2018-09-25 | 重庆大学 | 高可靠性螺栓拧紧电路系统及其控制方法 |
CN108733048A (zh) * | 2018-04-08 | 2018-11-02 | 深圳乐动机器人有限公司 | 一种室内移动机器人的回充控制方法、装置及系统 |
CN108733062A (zh) * | 2018-06-25 | 2018-11-02 | 山东大学 | 家庭陪护机器人自主充电系统及方法 |
CN108988403A (zh) * | 2017-05-31 | 2018-12-11 | 北京小米移动软件有限公司 | 自主充电系统、自主移动设备以及充电桩 |
CN109407665A (zh) * | 2018-09-28 | 2019-03-01 | 浙江大学 | 一种小型半自动无人驾驶配送车及配送路径规划方法 |
CN110336388A (zh) * | 2019-06-10 | 2019-10-15 | 南京航空航天大学 | 激光无线能量传输系统的能量管理保护方法及装置 |
CN110749908A (zh) * | 2019-09-27 | 2020-02-04 | 华为终端有限公司 | 定位方法及相关设备 |
CN112977140A (zh) * | 2021-04-21 | 2021-06-18 | 北京有感科技有限责任公司 | 无线充电系统对准设备 |
CN113009831A (zh) * | 2021-03-09 | 2021-06-22 | 渤海大学 | 水下机器人的事件触发自适应模糊容错保性能控制方法 |
CN115297148A (zh) * | 2022-10-10 | 2022-11-04 | 派欧尼尔环境净化工程(北京)有限公司 | 一种用于机器人充电桩的数据传输装置 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104284151A (zh) * | 2014-09-25 | 2015-01-14 | 国家电网公司 | 一种变电站地面巡检方法及巡检系统 |
CN204679862U (zh) * | 2015-06-16 | 2015-09-30 | 西安科技大学 | 一种激光引导式机器人充电桩 |
CN105629971A (zh) * | 2014-11-03 | 2016-06-01 | 贵州亿丰升华科技机器人有限公司 | 一种机器人自动充电系统及其控制方法 |
US20160257004A1 (en) * | 2015-03-06 | 2016-09-08 | King Fahd University Of Petroleum And Minerals | Target-seeking control method and system for mobile robots |
-
2016
- 2016-11-17 CN CN201611013284.3A patent/CN106383519B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104284151A (zh) * | 2014-09-25 | 2015-01-14 | 国家电网公司 | 一种变电站地面巡检方法及巡检系统 |
CN105629971A (zh) * | 2014-11-03 | 2016-06-01 | 贵州亿丰升华科技机器人有限公司 | 一种机器人自动充电系统及其控制方法 |
US20160257004A1 (en) * | 2015-03-06 | 2016-09-08 | King Fahd University Of Petroleum And Minerals | Target-seeking control method and system for mobile robots |
CN204679862U (zh) * | 2015-06-16 | 2015-09-30 | 西安科技大学 | 一种激光引导式机器人充电桩 |
Non-Patent Citations (1)
Title |
---|
黄颖等: "基于红外激光亮线识别的室内机器人自主充电系统设计", 《吉首大学学报(自然科学版)》 * |
Cited By (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108568660B (zh) * | 2017-03-10 | 2020-07-24 | 重庆大学 | 高可靠性螺栓拧紧电路系统及其控制方法 |
CN108568660A (zh) * | 2017-03-10 | 2018-09-25 | 重庆大学 | 高可靠性螺栓拧紧电路系统及其控制方法 |
CN108988403A (zh) * | 2017-05-31 | 2018-12-11 | 北京小米移动软件有限公司 | 自主充电系统、自主移动设备以及充电桩 |
CN107600373B (zh) * | 2017-09-05 | 2019-02-26 | 武汉大学 | 一种微型仿生水下机器人自主导航返程充电方法及系统 |
CN107600373A (zh) * | 2017-09-05 | 2018-01-19 | 武汉大学 | 一种微型仿生水下机器人自主导航返程充电方法及系统 |
CN108181904A (zh) * | 2017-12-29 | 2018-06-19 | 深圳市艾特智能科技有限公司 | 机器人避障方法、系统、可读存储介质及机器人 |
CN108390435A (zh) * | 2018-04-02 | 2018-08-10 | 广东欧珀移动通信有限公司 | 一种充电方法、系统及计算机可读存储介质 |
CN108390435B (zh) * | 2018-04-02 | 2020-08-25 | Oppo广东移动通信有限公司 | 一种充电方法、系统及计算机可读存储介质 |
CN108733048A (zh) * | 2018-04-08 | 2018-11-02 | 深圳乐动机器人有限公司 | 一种室内移动机器人的回充控制方法、装置及系统 |
CN108508897A (zh) * | 2018-04-20 | 2018-09-07 | 杭州蓝芯科技有限公司 | 一种基于视觉的机器人自动充电对准系统及方法 |
CN108733062A (zh) * | 2018-06-25 | 2018-11-02 | 山东大学 | 家庭陪护机器人自主充电系统及方法 |
CN109407665A (zh) * | 2018-09-28 | 2019-03-01 | 浙江大学 | 一种小型半自动无人驾驶配送车及配送路径规划方法 |
CN110336388A (zh) * | 2019-06-10 | 2019-10-15 | 南京航空航天大学 | 激光无线能量传输系统的能量管理保护方法及装置 |
CN110336388B (zh) * | 2019-06-10 | 2023-08-01 | 南京航空航天大学 | 激光无线能量传输系统的能量管理保护方法及装置 |
CN110749908A (zh) * | 2019-09-27 | 2020-02-04 | 华为终端有限公司 | 定位方法及相关设备 |
CN110749908B (zh) * | 2019-09-27 | 2022-05-06 | 荣耀终端有限公司 | 定位方法及相关设备 |
CN113009831A (zh) * | 2021-03-09 | 2021-06-22 | 渤海大学 | 水下机器人的事件触发自适应模糊容错保性能控制方法 |
CN113009831B (zh) * | 2021-03-09 | 2023-09-15 | 渤海大学 | 水下机器人的事件触发自适应模糊容错保性能控制方法 |
CN112977140A (zh) * | 2021-04-21 | 2021-06-18 | 北京有感科技有限责任公司 | 无线充电系统对准设备 |
CN115297148A (zh) * | 2022-10-10 | 2022-11-04 | 派欧尼尔环境净化工程(北京)有限公司 | 一种用于机器人充电桩的数据传输装置 |
CN115297148B (zh) * | 2022-10-10 | 2022-12-20 | 派欧尼尔环境净化工程(北京)有限公司 | 一种用于机器人充电桩的数据传输装置 |
Also Published As
Publication number | Publication date |
---|---|
CN106383519B (zh) | 2023-04-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106383519A (zh) | 一种机器人自主定位充电系统及方法 | |
CN106774298B (zh) | 基于摄像头与激光引导定位的机器人自主充电系统及方法 | |
CN105119338B (zh) | 移动机器人充电控制系统及方法 | |
CN105048533B (zh) | 小型多旋翼无人机自动充电系统 | |
CN102662400A (zh) | 割草机器人的路径规划算法 | |
KR101313546B1 (ko) | 부표형 카메라로봇 | |
CN206302168U (zh) | 巡检机器人自动充电激光对准系统 | |
CN108594820A (zh) | 一种履带式变电站巡检机器人自主越障系统及其控制方法 | |
CN206684574U (zh) | 一种移动机器人回充控制系统 | |
CN206825420U (zh) | 一种智能安防机器人 | |
KR101313545B1 (ko) | 부표형 자가발전로봇 | |
CN103358305A (zh) | 可闭环控制的多功能水中蛇形机器人 | |
CN205081492U (zh) | 移动机器人充电控制系统 | |
CN206200973U (zh) | 一种智能避障检测机器人 | |
CN108762259A (zh) | 基于无线信号强度的割草机器人遍历路径规划方法 | |
CN207127871U (zh) | 一种可避障碍的机器人 | |
US20210046205A1 (en) | Autonomous robot to remove pathogens from a target area | |
KR101313306B1 (ko) | 부표형 모니터링 로봇 | |
CN102360213A (zh) | 一种履带式环境探测机器人系统 | |
CN210016300U (zh) | 自移动设备和充电对接系统 | |
CN110315499A (zh) | 配电房巡检机器人 | |
CN202163514U (zh) | 一种履带式环境探测机器人系统 | |
CN206193537U (zh) | 履带机器人自主定位充电系统 | |
CN111564881A (zh) | 一种高压输电线路巡检机器人智能充电装置及控制方法 | |
CN215416385U (zh) | 一种机器人3d感知避障系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |