一种多个机器人之间相互定位及确认的方法与装置制造方法及图纸

一种多个机器人之间相互定位及确认的方法与装置，该方法是：当定位机器人需要定位时，首先通过无线收发器对周围机器人发送定位请求指令并开始计时，同时启动超声波换能器捕捉其他机器人发送的超声波定位信息；其他机器人在接收到定位请求指令后，启动超声波换能器发出超声波定位信息；当捕捉到接收端发出的超声波定位信息后计时停止，由单片机执行定位程序实现对该机器人当前位置的定位确认；该装置包括有多个机器人、无线收发器、超声波换能器、单片机及配套电路。本发明专利技术利用超声波实现机器人之间的相互定位及确认，增强了多机器人之间的协作能力，具有结构简单，使用方便，成本低，定位精度高的优点。

【技术实现步骤摘要】
【专利摘要】一种多个机器人之间相互定位及确认的方法与装置，该方法是：当定位机器人需要定位时，首先通过无线收发器对周围机器人发送定位请求指令并开始计时，同时启动超声波换能器捕捉其他机器人发送的超声波定位信息；其他机器人在接收到定位请求指令后，启动超声波换能器发出超声波定位信息；当捕捉到接收端发出的超声波定位信息后计时停止，由单片机执行定位程序实现对该机器人当前位置的定位确认；该装置包括有多个机器人、无线收发器、超声波换能器、单片机及配套电路。本专利技术利用超声波实现机器人之间的相互定位及确认，增强了多机器人之间的协作能力，具有结构简单，使用方便，成本低，定位精度高的优点。【专利说明】一种多个机器人之间相互定位及确认的方法与装置
本专利技术涉及一种智能机器的定位方法与装置，特别是涉及一种多个机器人之间相互定位及确认的方法与装置，属于智能机器的定位计算领域。
技术介绍
随着微电子技术、计算机技术及智能控制技术的快速发展，机器人相关的关键技术得到了更深入的研究。由于机器人的工作环境具有非结构性及不确定性的特点，使得多个机器人之间的相互定位技术成为一项十分关键的技术问题，没有这种功能，机器人就无法获知机器人之间的具体位置，会对多机器人间的相互协作产生影响。 哈尔滨工程大学的陆军等人在《基于全景视觉的机器人相互定位的研究》中公开了一种基于全景视觉的机器人相互定位的方法，2个全景摄像机和用于识别机器人的三色环圆柱体分别安装在不同的移动机器人上，利用光学视觉原理，通过CCD摄像机，获得包括另一个移动机器人的全方位景物图像.将得到的全景图像二值化处理后，通过噪声去除及八方区域生长算法找到符合条件的区域，并将找到区域的RGB颜色模型转换为HIS颜色模型.根据三色环圆柱体自身的3种颜色的固定顺序区别于背景的特点，识别出机器人上的目标三色环圆柱体，通过设计出的机器人相互定位算法，计算出机器人在世界坐标系下的坐标。但是该方法对机器人背景颜色要求较高，当背景颜色与自身颜色相近时，会发生定位错误，同时因受CCD摄像机广角的局限，使此方法的定位精度受到限制。
技术实现思路
本专利技术的目的就在于解决现有技术存在的问题，提供一种多机器人之间相互定位及确认的方法与装置，能够精确实施机器人对自身及周围其他机器人的位置关系，加快机器人对外界的响应，避免复杂的逻辑推理提高整个机器人系统的适用性与实时性。 为解决上述技术问题，本专利技术采用如下技术方案。 这种多个机器人之间相互定位及确认的方法，包括有定位机器人在内的多个机器人，其特点是定位步骤如下。 I)当机器人需要定位时，首先通过单片机控制定位机器人身上的无线收发器对周围机器人发送定位请求指令并开始计时，同时启动定位机器人身上的超声波换能器捕捉其他机器人发送的超声波定位信息。 2 )其他机器人在接收到定位请求指令后，启动机器人身上的超声波换能器发出超声波定位信息。 3)当定位机器人捕捉到接收端发出的超声波定位信息后计时停止，经单片机处理计算出该机器人的相对位置。 本专利技术利用定位机器人的无线收发器发出的无线电波作为时间基准，发送端发射超声波信号，同时开始计时直到捕捉到接收端发出超声波信号为止，捕捉值即为相对距离。通过加入对超声波接收头之间的距离校正，即可建立机器人之间的位置坐标关系，确定机器人的相对位置。 本专利技术给出的超声波信号的接收与发送均采用超声波换能器完成。 当定位请求命令发出后，若在规定时间内接收端捕捉到超声波信号，则单片机进行定位处理操作；若在规定时间内接收端仍未捕捉到超声波信号，则单片机重新发送定位请求指令。 这种多个机器人之间相互定位及确认的装置，包括有定位机器人在内的多个机器人、无线收发器、超声波换能器、单片机及配套电路，其特征是。 所述的定位机器人身上设置有无线收发器和超声波换能器，其余机器人身上也设置有无线收发器和超声波换能器，所述包括定位机器人在内的多个机器人身上的无线收发器和超声波换能器构成了机器人的定位系统并均与单片机相连。 所述的单片机完成控制定位信息的收发及对超声波信号的处理计算工作。 所述的配套电路为本专利技术发送端电路、本专利技术接收端放大电路和本专利技术接收端比较电路，其中本专利技术发送端电路为:采用无线模块nRF与STC单片机之间通过SPI接口进行通讯，ICl的1，2，3，4端分别连接到MCU的8，9，11，13管脚，其5，6，7分别接到MCU的6，12，10，其8号端接3.3V供电。Yl为MCU的24M晶振，XTALl和XTAL2分别连接到MCU的4、5号管脚，电容C3与电阻Rl组成复位电路，RST接到MCU的I号管脚。 本专利技术接收端放大电路为:当超声波换能器接收到来自其他机器人发出的超声波后，其转换的电信号由C0N2采集，经电容CRl滤波后连接到ICl的2号管脚，输出经电阻PR5反馈叠加到2号管脚，电阻PR3与PR4分压后连接到3号管脚，信号通过ICl进行放大检波处理，由ICl的I号管脚输出至超声波接收端比较电路。 本专利技术接收端比较电路为:由接收端放大电路输出放大后的电信号连接到IC2的3号管脚，经IC2电压跟随，I号管脚输出信号连接到IC3的2号管脚，IC3的3号管脚与变阻器PRll相连接，调节变阻器阻值，使3号管脚输入电位为经调试确定的背景噪声电位值。通过IC3实现对2、3号管脚电位值的比较，当IC3的I号管脚有输出时，说明接收到的信号为定位超声波信号，此时单片机开始计算位置；当IC3的I号管脚无输出时，说明收到的信号为背景噪音。 与现有技术相比，本专利技术的有益效果在于。 定位请求命令以无线电波为时间基准，通过计算发送接收超声波信号的时间差来定位机器人之间的相对位置关系，提高了多机器人之间的协作定位。本专利技术中涉及的方法和装置，具有结构简单，使用方便，成本低，定位精度高的优点。 【专利附图】【附图说明】 图1为本专利技术的装置连接示意图。 图2为本专利技术的发送端程序流程图。 图3为本专利技术的接收端程序流程图。 图4为本专利技术发送端电路。 图5为本专利技术接收端放大电路。 图6为本专利技术接收端比较电路。 【具体实施方式】 为使本专利技术的目的、技术方案和优点更加清楚，下面对本专利技术的实施方式做进一步地详细解释。 如图1所示，本专利技术提出一种多个机器人之间相互定位及确认的方法，其定位步骤如下。 I)定位机器人A首先通过单片机控制无线收发器发出定位请求指令，同时启动超声波换能器捕捉其他机器人B和C发送的超声波定位信息。 2)当其他机器人B和C接收到定位请求指令后，启动超声波换能器发出超声波定位信号。 3)当定位机器人A捕捉到其他机器人B和C发送的超声波定位信息后，经单片机处理得出该定位机器人A的相对位置。 如图1所示，本专利技术提出一种多个机器人之间相互定位及确认的装置，包括:有定位机器人在内的多个机器人、无线收发器、超声波换能器、单片机及配套电路，定位机器人身上设置有无线收发器和超声波换能器，其余机器人身上也设置有无线收发器和超声波换能器，包括定位机器人在内的多个机器人身上的无线收发器和超声波换能器构成了机器人的定位系统并均与单片机相连。 设A为定位机器人，当要对机器人A定位时，定位机器人A通过无线收发器向本文档来自技高网...

【技术保护点】
一种多个机器人之间相互定位及确认的方法，包括有定位机器人在内的多个机器人，其特征在于具体的定位步骤如下：1）当机器人需要定位时，首先通过单片机控制定位机器人身上的无线收发器对周围机器人发送定位请求指令并开始计时，同时启动定位机器人身上的超声波换能器捕捉其他机器人发送的超声波定位信息；2）其他机器人在接收到定位请求指令后，启动机器人身上的超声波换能器发出超声波定位信息；3）当定位机器人捕捉到接收端发出的超声波定位信息后计时停止，经单片机处理计算出该机器人的相对位置。

【技术特征摘要】

【专利技术属性】
技术研发人员：侯春光，赵洋，张宇飞，曹云东，
申请(专利权)人：沈阳工业大学，
类型：发明
国别省市：辽宁;21