CN104503448B - Device used to define working area of mobile robot and defining method thereof - Google Patents
Device used to define working area of mobile robot and defining method thereof Download PDFInfo
- Publication number
- CN104503448B CN104503448B CN201410570402.5A CN201410570402A CN104503448B CN 104503448 B CN104503448 B CN 104503448B CN 201410570402 A CN201410570402 A CN 201410570402A CN 104503448 B CN104503448 B CN 104503448B
- Authority
- CN
- China
- Prior art keywords
- capacitor
- pin
- boundary
- mobile robot
- inductance
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 22
- 230000006698 induction Effects 0.000 claims abstract description 80
- 238000001514 detection method Methods 0.000 claims abstract description 38
- 239000004020 conductor Substances 0.000 claims abstract description 13
- 230000005674 electromagnetic induction Effects 0.000 claims abstract description 7
- 239000003990 capacitor Substances 0.000 claims description 417
- 239000013078 crystal Substances 0.000 claims description 36
- 239000000463 material Substances 0.000 abstract description 8
- XEEYBQQBJWHFJM-UHFFFAOYSA-N Iron Chemical compound [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 238000004140 cleaning Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 239000011888 foil Substances 0.000 description 2
- 229910052742 iron Inorganic materials 0.000 description 2
- 238000013138 pruning Methods 0.000 description 2
- 238000013473 artificial intelligence Methods 0.000 description 1
- 239000000428 dust Substances 0.000 description 1
- 230000005288 electromagnetic effect Effects 0.000 description 1
- 238000010408 sweeping Methods 0.000 description 1
Landscapes
- Manipulator (AREA)
Abstract
本发明公开了一种用于界定移动机器人工作区域的装置及其界定方法,该装置包括控制器和至少一个信号探测器,控制器和信号探测器安装在移动机器人上,信号探测器包括用于和导电材料的边界产生电磁感应现象的感应线圈和用于获取所述的感应线圈的损耗电阻或谐振频率的检测电路,感应线圈的在移动机器人上的位置高于边界,检测电路实时获取感应线圈的损耗电阻或谐振频率,并将损耗电阻或谐振频率转化为实时数字信号后发送给所述的控制器,控制器将实时数字信号与参考值范围进行对比,如果落入参考值范围内,则移动机器人到达边界;优点是仅需采用导电材料作为无源边界,边界材料选择的范围广,不需要额外配备信号发生器,成本较低。
The invention discloses a device for defining the working area of a mobile robot and a method for defining the same. The device includes a controller and at least one signal detector, the controller and the signal detector are installed on the mobile robot, and the signal detector includes a An induction coil that generates electromagnetic induction with the boundary of the conductive material and a detection circuit for obtaining the loss resistance or resonance frequency of the induction coil, the position of the induction coil on the mobile robot is higher than the boundary, and the detection circuit obtains the induction coil in real time The loss resistance or resonant frequency, and convert the loss resistance or resonant frequency into a real-time digital signal and send it to the controller. The controller compares the real-time digital signal with the reference value range, and if it falls within the reference value range, then The mobile robot reaches the boundary; the advantage is that only conductive materials need to be used as the passive boundary, the boundary material can be selected in a wide range, no additional signal generator is required, and the cost is low.
Description
技术领域technical field
本发明涉及一种移动机器人工作区域界定技术,尤其是涉及一种用于界定移动机器人工作区域的装置及其界定方法。The invention relates to a technology for defining a working area of a mobile robot, in particular to a device for defining a working area of a mobile robot and a method for defining the working area.
背景技术Background technique
移动机器人技术起源于国外,目前麻省理工、佐治亚理工、加州理工和斯坦福等研究机构都在大力研究这一方面的内容,并且在人工智能领域和机器人硬件设计领域都有较显著的成果。市场上性能较好的用于清洁或修剪的移动机器人大多都来自于国外大型公司,例如Irobot公司的Roomba,Karcher公司的RC和Fmart公司的FM等清洁机器人,以及Friendly Machines公司的Robomow,Zucchetti公司的Ambrigio Robo-Lawnmower和Electrolux公司的Husqvarna Auto Mower等割草机器人。这些移动机器人都通过在一个指定的工作区域内遍历来完成清洁或修剪工作,由此,界定移动机器人工作区域的装置成为移动机器人必不可少的组成部分。Mobile robot technology originated abroad. Currently, research institutions such as MIT, Georgia Tech, Caltech and Stanford are vigorously researching this aspect, and have achieved remarkable results in the field of artificial intelligence and robot hardware design. Most of the mobile robots with better performance on the market for cleaning or pruning come from large foreign companies, such as Roomba from Irobot, RC from Karcher and FM from Fmart, and Robomow from Friendly Machines, Zucchetti Lawn mower robots such as the Ambrigio Robo-Lawnmower and the Husqvarna Auto Mower from Electrolux. These mobile robots complete the cleaning or pruning work by traversing in a designated working area, thus, the device that defines the working area of the mobile robot becomes an indispensable part of the mobile robot.
专利号为US20080097645的美国专利文件中公开了一种用于界定移动机器人工作区域的装置。该装置基于电磁效应对边界进行检测,主要包括控制器、信号发生器和信号探测器。该装置用连接有信号发生器的电缆线围成一个方形,形成一个有源的方形边界,边界处磁场强度最大。信号发生器使边界产生磁场,在移动机器人移动接近边界的过程中,安装在移动机器人上的信号探测器实时获取边界产生的磁场信号,信号探测器将获取的磁场信号转换成电压信号并实时传送给控制器,控制器将接收的电压信号与其内部存储的边界处磁场强度对应的参考电压信号进行对比,判定移动机器人是否达到边界,根据判定结果控制移动机器人的行进方向,由此保证移动机器人在边界所围成的工作区域内移动。US Patent No. US20080097645 discloses a device for defining a working area of a mobile robot. The device detects the boundary based on the electromagnetic effect, and mainly includes a controller, a signal generator and a signal detector. The device forms a square with cables connected with a signal generator to form an active square boundary, where the magnetic field intensity is the largest. The signal generator makes the boundary generate a magnetic field. When the mobile robot moves close to the boundary, the signal detector installed on the mobile robot acquires the magnetic field signal generated by the boundary in real time, and the signal detector converts the obtained magnetic field signal into a voltage signal and transmits it in real time. To the controller, the controller compares the received voltage signal with the reference voltage signal corresponding to the magnetic field strength at the boundary stored inside, determines whether the mobile robot has reached the boundary, and controls the direction of travel of the mobile robot according to the determination result, thereby ensuring that the mobile robot is at the boundary. Move within the working area enclosed by the boundaries.
但是上述用于界定移动机器人工作区域的装置存在以下问题:边界材料受到的限制较大,为了使边界产生磁场,必须配备信号发生器来和电缆线形成有源边界,另外每个边界需要一个信号发生器,如果在已有边界内铺设新边界的话,需要额外的信号发生器,成本较高。But the above-mentioned device that is used to define the working area of the mobile robot has the following problems: the limit of the boundary material is relatively large, in order to make the boundary generate a magnetic field, a signal generator must be equipped to form an active boundary with the cable, and each boundary requires a signal Generator, if a new boundary is laid within the existing boundary, an additional signal generator is required, and the cost is high.
发明内容Contents of the invention
本发明所要解决的技术问题之一是提供一种用于界定移动机器人工作区域的装置,该装置中信号探测器包括感应线圈和检测电路,基于感应线圈与导电材料靠近时会产生电磁感应现象,感应线圈的损耗电阻和谐振频率的大小会发生改变的原理,检测电路实时获取感应线圈损耗电阻或谐振频率即可确定边界,由此仅需采用导电材料作为无源边界,边界材料选择的范围广,并且不需要额外配备信号发生器,成本较低。One of the technical problems to be solved by the present invention is to provide a device for defining the working area of the mobile robot. The signal detector in the device includes an induction coil and a detection circuit. Based on the fact that the induction coil is close to the conductive material, electromagnetic induction will occur. The principle that the loss resistance and resonant frequency of the induction coil will change. The detection circuit can obtain the loss resistance or resonant frequency of the induction coil in real time to determine the boundary. Therefore, only conductive materials need to be used as the passive boundary, and the range of boundary material selection is wide , and does not need to be equipped with additional signal generators, and the cost is low.
本发明解决上述技术问题之一所采用的技术方案为:一种用于界定移动机器人工作区域的装置,包括控制器和至少一个信号探测器,所述的控制器和所述的信号探测器安装在移动机器人上,其特征在于所述的信号探测器包括用于和导电材料的边界产生电磁感应现象的感应线圈和用于获取所述的感应线圈的损耗电阻或谐振频率的检测电路,所述的感应线圈在移动机器人上的位置高于边界,所述的控制器中存储有所述的感应线圈伸到边界上方时的损耗电阻或谐振频率的参考值范围,所述的检测电路实时获取所述的感应线圈的损耗电阻或谐振频率,并将损耗电阻或谐振频率转化为数字信号后发送给所述的控制器,所述的控制器将实时数字信号的值与参考值范围进行对比,如果实时数字信号的值落入参考值范围内,则移动机器人到达边界。The technical solution adopted by the present invention to solve one of the above technical problems is: a device for defining the working area of a mobile robot, including a controller and at least one signal detector, the controller and the signal detector are installed On the mobile robot, it is characterized in that the signal detector includes an induction coil for generating electromagnetic induction phenomenon with the boundary of the conductive material and a detection circuit for obtaining the loss resistance or resonance frequency of the induction coil, the said The position of the induction coil on the mobile robot is higher than the boundary, and the reference value range of the loss resistance or the resonant frequency when the induction coil extends above the boundary is stored in the controller, and the detection circuit obtains the reference value range of the resonance frequency in real time. The loss resistance or resonant frequency of the induction coil described above, and the loss resistance or resonant frequency is converted into a digital signal and sent to the controller, and the controller compares the value of the real-time digital signal with the reference value range, if The value of the real-time digital signal falls within the range of the reference value, and the mobile robot reaches the boundary.
所述的检测电路包括电感数字转换器、第一电容、第二电容、第三电容、第四电容、第五电容、第六电容和第七电容,所述的电感数字转换器的型号为LDC1000、LDC1041或LDC1051,所述的电感数字转换器的第4脚、所述的第一电容的一端和所述的第二电容的一端连接且其连接端接入3.3V电压,所述的第一电容的另一端和所述的第二电容的另一端均接地,所述的电感数字转换器的第13脚和所述的第三电容的一端连接,所述的第三电容的另一端接地,所述的电感数字转换器的第7脚和所述的第四电容的一端连接,所述的第四电容的另一端和所述的电感数字转换器的第8脚连接,所述的电感数字转换器的第11脚和第17脚均接模拟地,所述的电感数字转化器的第9脚、所述的第七电容的一端和所述的感应线圈的一端连接,所述的电感数字转换器的第10脚、所述的第七电容的另一端和所述的感应线圈的另一端连接,所述的电感数字转换器的第12脚、所述的第五电容的一端和所述的第六电容的一端连接且其连接端接入5V电压,所述的第五电容的另一端和所述的第六电容的另一端均接模拟地,所述的电感数字转换器的第1脚、第2脚、第3脚、第5脚、第14脚和第16脚分别与所述的控制器连接。The detection circuit includes an inductance-to-digital converter, a first capacitor, a second capacitor, a third capacitor, a fourth capacitor, a fifth capacitor, a sixth capacitor, and a seventh capacitor, and the model of the inductance-to-digital converter is LDC1000 , LDC1041 or LDC1051, the 4th pin of the inductance-to-digital converter, one end of the first capacitor and one end of the second capacitor are connected and the connection end is connected to 3.3V voltage, the first The other end of the capacitor and the other end of the second capacitor are grounded, the 13th pin of the inductance-to-digital converter is connected to one end of the third capacitor, and the other end of the third capacitor is grounded, The 7th pin of the inductance-to-digital converter is connected to one end of the fourth capacitor, the other end of the fourth capacitor is connected to the 8th pin of the inductance-to-digital converter, and the inductance digital Both the 11th pin and the 17th pin of the converter are connected to the analog ground, the 9th pin of the inductance-to-digital converter, one end of the seventh capacitor and one end of the induction coil are connected, and the inductance digital The 10th pin of the converter, the other end of the seventh capacitor and the other end of the induction coil are connected, the 12th pin of the inductance-to-digital converter, one end of the fifth capacitor and the One end of the sixth capacitor is connected and its connection end is connected to 5V voltage, the other end of the fifth capacitor and the other end of the sixth capacitor are both connected to analog ground, and the first inductance-to-digital converter of the The pin, the 2nd pin, the 3rd pin, the 5th pin, the 14th pin and the 16th pin are respectively connected with the controller.
所述的控制器包括为型号为STM32F103的控制芯片、型号为SPX1117的稳压芯片、第一电阻、第二电阻、第三电阻、第四电阻、第八电容、第九电容、第十电容、第十一电容、第十二电容、第十三电容、第十四电容、第十五电容、第十六电容、第十七电容、第十八电容、第十九电容、第二十电容、第二十一电容、第二十二电容、第二十三电容、第一晶振、第二晶振、按键和连接端子;The controller includes a control chip of model STM32F103, a voltage regulator chip of model SPX1117, a first resistor, a second resistor, a third resistor, a fourth resistor, an eighth capacitor, a ninth capacitor, a tenth capacitor, The eleventh capacitor, the twelfth capacitor, the thirteenth capacitor, the fourteenth capacitor, the fifteenth capacitor, the sixteenth capacitor, the seventeenth capacitor, the eighteenth capacitor, the nineteenth capacitor, the twentieth capacitor, The twenty-first capacitor, the twenty-second capacitor, the twenty-third capacitor, the first crystal oscillator, the second crystal oscillator, buttons and connection terminals;
所述的第一电阻的一端接地,所述的第一电阻的另一端接模拟地,所述的稳压芯片的第2脚、所述的第八电容的一端和所述的第九电容的一端连接且其连接端接入5V电压,所述的稳压芯片的第3脚、所述的第十电容的一端和所述的第十一电容的一端连接且其连接端输出3.3V电压,所述的第八电容的另一端、所述的第九电容的另一端、所述的第十电容的另一端和所述的第十一电容的另一端均接地;One end of the first resistor is grounded, the other end of the first resistor is connected to the analog ground, the second pin of the voltage regulator chip, one end of the eighth capacitor and the ninth capacitor One end is connected and its connection end is connected to 5V voltage, the third pin of the voltage regulator chip, one end of the tenth capacitor and one end of the eleventh capacitor are connected and the connection end outputs 3.3V voltage, The other end of the eighth capacitor, the other end of the ninth capacitor, the other end of the tenth capacitor and the other end of the eleventh capacitor are all grounded;
所述的第十二电容的一端、所述的第一晶振的第2脚和所述的控制芯片的第12脚连接,所述的第十二电容的另一端和所述的第十三电容的一端均接地,所述的第十三电容的另一端、所述的第一晶振的第1脚和所述的第二电阻的一端连接,所述的第二电阻的另一端和所述的控制芯片的第13脚连接;One end of the twelfth capacitor, the second pin of the first crystal oscillator and the twelfth pin of the control chip are connected, the other end of the twelfth capacitor is connected to the thirteenth capacitor One end of both is grounded, the other end of the thirteenth capacitor, the first pin of the first crystal oscillator is connected to one end of the second resistor, the other end of the second resistor is connected to the The 13th pin connection of the control chip;
所述的第十四电容的一端、所述的第二晶振的第2脚和所述的控制芯片的第8脚连接,所述的第十四电容的另一端和所述的第十五电容的一端均接地,所述的第十五电容的另一端、所述的第二晶振的第1脚和所述的控制芯片的第9脚连接;One end of the fourteenth capacitor, the second pin of the second crystal oscillator and the eighth pin of the control chip are connected, the other end of the fourteenth capacitor is connected to the fifteenth capacitor One end of both is grounded, the other end of the fifteenth capacitor, the first pin of the second crystal oscillator and the ninth pin of the control chip are connected;
所述的第十六电容的一端、所述的第十七电容的一端、所述的第十八电容的一端、所述的第十九电容的一端、所述的第二十电容的一端、所述的第二十一电容的一端和所述的第二十二电容的一端连接且其连接端接入3.3V电压,所述的第十六电容的另一端、所述的第十七电容的另一端、所述的第十八电容的另一端、所述的第十九电容的另一端、所述的第二十电容的另一端、所述的第二十一电容的另一端和所述的第二十二电容的另一端均接地;One end of the sixteenth capacitor, one end of the seventeenth capacitor, one end of the eighteenth capacitor, one end of the nineteenth capacitor, one end of the twentieth capacitor, One end of the twenty-first capacitor is connected to one end of the twenty-second capacitor and its connection end is connected to a 3.3V voltage, the other end of the sixteenth capacitor, the seventeenth capacitor the other end of the eighteenth capacitor, the other end of the nineteenth capacitor, the other end of the twentieth capacitor, the other end of the twenty-first capacitor and the The other end of the twenty-second capacitor mentioned above is all grounded;
所述的第三电阻的一端接入3.3V电压,所述的第三电阻的另一端、所述的连接端子的第2脚和所述的控制芯片的第94脚连接,所述的连接端子的第1脚接地;所述的第四电阻的一端接入3.3V电压,所述的第四电阻的另一端、所述的第二十三电容的一端、所述的按键的一端和所述的控制芯片的第14脚连接,所述的按键的另一端和所述的第二十三电容的另一端均接地;One end of the third resistor is connected to 3.3V voltage, the other end of the third resistor, the second pin of the connecting terminal is connected to the 94th pin of the control chip, and the connecting terminal The first pin of the ground is grounded; one end of the fourth resistor is connected to a 3.3V voltage, the other end of the fourth resistor, one end of the twenty-third capacitor, one end of the button and the The 14th pin of the control chip is connected, and the other end of the button and the other end of the twenty-third capacitor are grounded;
所述的控制芯片的第47脚和所述的电感数字转换器的第16脚连接,所述的控制芯片的第48脚和所述的电感数字转换器的第14脚连接,所述的控制芯片的第51脚和所述的电感数字转换器的第2脚连接,所述的控制芯片的第52脚和所述的电感数字转换器的第1脚连接,所述的控制芯片的第53脚和所述的电感数字转换器的第5脚连接,所述的控制芯片的第54脚和所述的电感数字转换器的第3脚连接,所述的控制芯片的第6脚、第11脚、第28脚、第50脚、第75脚和第100脚均接入3.3V电压,所述的控制芯片的第10脚、第27脚、第49脚、第74脚和第99脚均接地。The 47th pin of the control chip is connected to the 16th pin of the inductance-to-digital converter, the 48th pin of the control chip is connected to the 14th pin of the inductance-to-digital converter, and the control The 51st pin of the chip is connected to the 2nd pin of the inductance-to-digital converter, the 52nd pin of the control chip is connected to the 1st pin of the inductance-to-digital converter, and the 53rd pin of the control chip The pin is connected to the 5th pin of the inductance-to-digital converter, the 54th pin of the control chip is connected to the 3rd pin of the inductance-to-digital converter, the 6th pin, the 11th pin of the control chip Pin, 28th pin, 50th pin, 75th pin and 100th pin are all connected to 3.3V voltage, and the 10th pin, 27th pin, 49th pin, 74th pin and 99th pin of the control chip are connected grounded.
本发明所要解决的技术问题之二是提供一种用于界定移动机器人工作区域的装置的界定方法,该界定方法基于感应线圈与导电材料靠近时会产生电磁感应现象,感应线圈的损耗电阻和谐振频率的大小会发生改变的原理,通过检测电路实时获取感应线圈损耗电阻或谐振频率即可确定边界,在确定边界后通过控制器驱动引导移动机器人在工作区域内遍历,实现边界的界定和移动机器人工作的引导,由此该方法中仅需采用导电材料作为无源边界,边界材料选择的范围广,并且不需要额外配备信号发生器,成本较低,且可实现工作区域的完整遍历。The second technical problem to be solved by the present invention is to provide a method for defining a device for defining the working area of a mobile robot. The principle that the magnitude of the frequency will change. The boundary can be determined by obtaining the loss resistance or resonance frequency of the induction coil in real time through the detection circuit. After the boundary is determined, the controller drives and guides the mobile robot to traverse in the working area to realize the definition of the boundary and the mobile robot. The guidance of the work, so this method only needs to use conductive materials as the passive boundary, the range of boundary material selection is wide, and no additional signal generator is required, the cost is low, and the complete traversal of the working area can be realized.
与现有技术相比,本发明的装置的优点在于通过设置感应线圈和检测电路,基于感应线圈与导电材料靠近时会产生电磁感应现象,感应线圈的损耗电阻和谐振频率的大小会发生改变的原理,控制器中存储有感应线圈伸到边界上方时的损耗电阻或谐振频率对应的参考值范围,检测电路实时获取感应线圈的损耗电阻或谐振频率,并将损耗电阻或谐振频率转化为数字信号后发送给控制器,控制器将实时数字信号的值与参考值范围进行对比,如果实时数字信号的值落入参考值范围内,则移动机器人到达边界,实时获取感应线圈损耗电阻或谐振频率即可确定边界,由此仅需采用导电材料作为无源边界,边界材料选择的范围广,并且不需要额外配备信号发生器,成本较低。Compared with the prior art, the advantage of the device of the present invention is that by setting the induction coil and the detection circuit, based on the electromagnetic induction phenomenon will occur when the induction coil is close to the conductive material, the loss resistance and the resonance frequency of the induction coil will change. Principle, the controller stores the reference value range corresponding to the loss resistance or resonance frequency when the induction coil extends above the boundary, the detection circuit obtains the loss resistance or resonance frequency of the induction coil in real time, and converts the loss resistance or resonance frequency into a digital signal After sending it to the controller, the controller compares the value of the real-time digital signal with the reference value range. If the value of the real-time digital signal falls within the reference value range, the mobile robot reaches the boundary and obtains the loss resistance of the induction coil or the resonance frequency in real time. The boundary can be determined, so only conductive materials need to be used as the passive boundary, the boundary material can be selected in a wide range, and no additional signal generator is required, and the cost is low.
本发明解决上述技术问题之二所采用的技术方案为:一种用于界定移动机器人工作区域的装置的界定方法,其特征在于所述的信号探测器的数量为两个,两个所述的信号探测器的感应线圈并行设置,具体包括以下步骤:The technical solution adopted by the present invention to solve the above-mentioned technical problem 2 is: a method for defining a device for defining the working area of a mobile robot, which is characterized in that the number of the signal detectors is two, and the two The induction coils of the signal detector are set in parallel, specifically including the following steps:
①将控制器和信号探测器进行初始化;① Initialize the controller and signal detector;
②将感应线圈伸到边界上方时的损耗电阻或谐振频率对应的参考值范围Vmin~Vmax存入到控制器中,其中Vmin为感应线圈开始进入边界上方时损耗电阻或谐振频率对应的数字信号的大小,Vmax为感应线圈完全进入边界上方时损耗电阻或谐振频率对应的数字信号的大小;② Store the loss resistance or the reference value range Vmin~Vmax corresponding to the resonance frequency when the induction coil extends above the boundary into the controller, where Vmin is the loss resistance or the digital signal corresponding to the resonance frequency when the induction coil starts to enter the boundary Size, Vmax is the size of the digital signal corresponding to the loss resistance or the resonance frequency when the induction coil fully enters the boundary;
③调整移动机器人进入工作区域的移动方向:③Adjust the moving direction of the mobile robot into the working area:
③-1控制器驱动移动机器人经一条边界进入工作区域,两个检测电路实时获取感应线圈的损耗电阻或谐振频率,并将损耗电阻或谐振频率转化为实时数字信号后发送给控制器,将两个检测电路实时获取的损耗电阻或谐振频率对应的数字信号的值记为V1和V2;③-1 The controller drives the mobile robot to enter the working area through a boundary, and the two detection circuits obtain the loss resistance or resonance frequency of the induction coil in real time, and convert the loss resistance or resonance frequency into a real-time digital signal and send it to the controller. The value of the digital signal corresponding to the loss resistance or the resonant frequency obtained by the detection circuit in real time is denoted as V1 and V2;
③-2如果V1和V2中有一个先落入Vmin~Vmax范围内,则控制器驱动移动机器人调整移动方向至V1和V2均落入Vmin~Vmax范围内且大小相等;如果V1和V2同时落入Vmin~Vmax范围内时,如果V1和V2相等,则移动机器人移动方向不用调整,如果V1和V2不相等,则控制器驱动移动机器人调整移动方向至V1和V2大小相等且均落入Vmin~Vmax范围内,此时移动机器人在工作区域的移动方向垂直于进入处边界;③-2 If one of V1 and V2 falls within the range of Vmin~Vmax first, the controller drives the mobile robot to adjust the moving direction until both V1 and V2 fall within the range of Vmin~Vmax and are equal in size; When entering the range of Vmin~Vmax, if V1 and V2 are equal, the moving direction of the mobile robot does not need to be adjusted. If V1 and V2 are not equal, the controller drives the mobile robot to adjust the moving direction until V1 and V2 are equal in size and fall into Vmin~ Within the range of Vmax, at this time, the moving direction of the mobile robot in the working area is perpendicular to the boundary of the entry point;
④控制移动机器人在工作区域的右边区域遍历,具体过程为:④ Control the mobile robot to traverse in the right area of the working area, the specific process is:
④-1移动机器人沿垂直于进入处边界的方向向前移动,两个检测电路实时获取所述的感应线圈的损耗电阻或谐振频率,并将损耗电阻或谐振频率转化为实时数字信号后发送给控制器,控制器将实时数字信号的值与参考值范围Vmin~Vmax进行对比,如果实时数字信号的值落入参考值范围内,则移动机器人到达与进入处边界相对的边界;④-1 The mobile robot moves forward along the direction perpendicular to the boundary of the entrance, and the two detection circuits obtain the loss resistance or resonance frequency of the induction coil in real time, and convert the loss resistance or resonance frequency into a real-time digital signal and send it to The controller, the controller compares the value of the real-time digital signal with the reference value range Vmin~Vmax, if the value of the real-time digital signal falls within the reference value range, the mobile robot reaches the boundary opposite to the boundary of the entry point;
④-2当移动机器人到达与进入处边界相对的边界处时,控制器控制移动机器人顺时针转动90度后平行于与进入处边界相对的边界的方向向前移动一段距离d,d等于移动机器人的工作宽度,然后再顺时针转动90度向前移动;④-2 When the mobile robot reaches the boundary opposite to the entry boundary, the controller controls the mobile robot to turn 90 degrees clockwise and then move forward for a distance d parallel to the direction of the boundary opposite to the entry boundary, where d is equal to the mobile robot working width, and then turn 90 degrees clockwise to move forward;
④-3每次遇到与进入处边界相对的边界后,都重复步骤④-2,并统计移动机器人沿平行于与进入处边界相对的边界的方向向前移动的次数,将该次数记为n;当移动机器人在沿平行于与进入处边界相对的边界移动时到达右边边界时,停止移动,控制移动机器人顺时针转动90度后向前移动至边界处,完成右边区域遍历;④-3 Repeat step ④-2 every time it encounters the boundary opposite to the boundary of the entry point, and count the number of times the mobile robot moves forward along the direction parallel to the boundary opposite to the boundary of the entry point, and record the number of times as n; when the mobile robot reaches the right boundary while moving along the boundary parallel to the boundary opposite to the entry boundary, stop moving, control the mobile robot to rotate clockwise 90 degrees and then move forward to the boundary to complete the traversal of the right area;
⑤控制移动机器人在右边边界处顺时针转动90度后垂直于右边边界的方向移动大小为n*d的距离后再顺时针转动90度,此时移动机器人的移动方向垂直于进入处边界;⑤Control the mobile robot to rotate 90 degrees clockwise at the right boundary, and then move a distance of n*d perpendicular to the right boundary, and then rotate 90 degrees clockwise. At this time, the moving direction of the mobile robot is perpendicular to the boundary of the entry place;
⑥控制移动机器人在工作区域的左边区域遍历,具体过程为:⑥Control the mobile robot to traverse in the left area of the working area, the specific process is:
⑥-1移动机器人沿垂直于进入处边界的方向向前移动,两个检测电路实时获取所述的感应线圈的损耗电阻或谐振频率,并将损耗电阻或谐振频率转化为实时数字信号后发送给控制器,控制器将实时数字信号的值与参考值范围Vmin~Vmax进行对比,如果实时数字信号的值落入参考值范围内,则移动机器人到达与进入处边界相对的边界;⑥-1 The mobile robot moves forward along the direction perpendicular to the boundary of the entrance, and the two detection circuits obtain the loss resistance or resonance frequency of the induction coil in real time, and convert the loss resistance or resonance frequency into a real-time digital signal and send it to The controller, the controller compares the value of the real-time digital signal with the reference value range Vmin~Vmax, if the value of the real-time digital signal falls within the reference value range, the mobile robot reaches the boundary opposite to the boundary of the entry point;
⑥-2当移动机器人到达与进入处边界相对的边界处时,控制器控制移动机器人逆时针转动90度后沿平行于与进入处边界相对的边界的方向向前移动一段距离d,d等于移动机器人的工作宽度,然后再逆时针转动90度向前移动;⑥-2 When the mobile robot reaches the boundary opposite to the entry boundary, the controller controls the mobile robot to turn 90 degrees counterclockwise and then move forward for a distance d in a direction parallel to the boundary opposite to the entry boundary, where d is equal to the movement The working width of the robot, and then turn 90 degrees counterclockwise to move forward;
⑥-3每次遇到与进入处边界相对的边界后,都重复步骤⑥-2,当移动机器人移动到达左边边界时,停止移动,控制移动机器人逆时针转动90度后向前移动至边界处,完成左边区域遍历。⑥-3 Repeat step ⑥-2 every time it encounters the boundary opposite to the boundary of the entry point. When the mobile robot moves to the left boundary, stop moving, control the mobile robot to turn 90 degrees counterclockwise and move forward to the boundary , to complete the left area traversal.
所述的检测电路包括电感数字转换器、第一电容、第二电容、第三电容、第四电容、第五电容、第六电容和第七电容,所述的电感数字转换器的型号为LDC1000、LDC1041或LDC1051,所述的电感数字转换器的第4脚、所述的第一电容的一端和所述的第二电容的一端连接且其连接端接入3.3V电压,所述的第一电容的另一端和所述的第二电容的另一端均接地,所述的电感数字转换器的第13脚和所述的第三电容的一端连接,所述的第三电容的另一端接地,所述的电感数字转换器的第7脚和所述的第四电容的一端连接,所述的第四电容的另一端和所述的电感数字转换器的第8脚连接,所述的电感数字转换器的第11脚和第17脚均接模拟地,所述的电感数字转化器的第9脚、所述的第七电容的一端和所述的感应线圈的一端连接,所述的电感数字转换器的第10脚、所述的第七电容的另一端和所述的感应线圈的另一端连接,所述的电感数字转换器的第12脚、所述的第五电容的一端和所述的第六电容的一端连接且其连接端接入5V电压,所述的第五电容的另一端和所述的第六电容的另一端均接模拟地,所述的电感数字转换器的第1脚、第2脚、第3脚、第5脚、第14脚和第16脚分别与所述的控制器连接。The detection circuit includes an inductance-to-digital converter, a first capacitor, a second capacitor, a third capacitor, a fourth capacitor, a fifth capacitor, a sixth capacitor, and a seventh capacitor, and the model of the inductance-to-digital converter is LDC1000 , LDC1041 or LDC1051, the 4th pin of the inductance-to-digital converter, one end of the first capacitor and one end of the second capacitor are connected and the connection end is connected to 3.3V voltage, the first The other end of the capacitor and the other end of the second capacitor are grounded, the 13th pin of the inductance-to-digital converter is connected to one end of the third capacitor, and the other end of the third capacitor is grounded, The 7th pin of the inductance-to-digital converter is connected to one end of the fourth capacitor, the other end of the fourth capacitor is connected to the 8th pin of the inductance-to-digital converter, and the inductance digital Both the 11th pin and the 17th pin of the converter are connected to the analog ground, the 9th pin of the inductance-to-digital converter, one end of the seventh capacitor and one end of the induction coil are connected, and the inductance digital The 10th pin of the converter, the other end of the seventh capacitor and the other end of the induction coil are connected, the 12th pin of the inductance-to-digital converter, one end of the fifth capacitor and the One end of the sixth capacitor is connected and its connection end is connected to 5V voltage, the other end of the fifth capacitor and the other end of the sixth capacitor are both connected to analog ground, and the first inductance-to-digital converter of the The pin, the 2nd pin, the 3rd pin, the 5th pin, the 14th pin and the 16th pin are respectively connected with the controller.
所述的控制器包括为型号为STM32F103的控制芯片、型号为SPX1117的稳压芯片、第一电阻、第二电阻、第三电阻、第四电阻、第八电容、第九电容、第十电容、第十一电容、第十二电容、第十三电容、第十四电容、第十五电容、第十六电容、第十七电容、第十八电容、第十九电容、第二十电容、第二十一电容、第二十二电容、第二十三电容、第一晶振、第二晶振、按键和连接端子;The controller includes a control chip of model STM32F103, a voltage regulator chip of model SPX1117, a first resistor, a second resistor, a third resistor, a fourth resistor, an eighth capacitor, a ninth capacitor, a tenth capacitor, The eleventh capacitor, the twelfth capacitor, the thirteenth capacitor, the fourteenth capacitor, the fifteenth capacitor, the sixteenth capacitor, the seventeenth capacitor, the eighteenth capacitor, the nineteenth capacitor, the twentieth capacitor, The twenty-first capacitor, the twenty-second capacitor, the twenty-third capacitor, the first crystal oscillator, the second crystal oscillator, buttons and connection terminals;
所述的第一电阻的一端接地,所述的第一电阻的另一端接模拟地,所述的稳压芯片的第2脚、所述的第八电容的一端和所述的第九电容的一端连接且其连接端接入5V电压,所述的稳压芯片的第3脚、所述的第十电容的一端和所述的第十一电容的一端连接且其连接端输出3.3V电压,所述的第八电容的另一端、所述的第九电容的另一端、所述的第十电容的另一端和所述的第十一电容的另一端均接地;One end of the first resistor is grounded, the other end of the first resistor is connected to the analog ground, the second pin of the voltage regulator chip, one end of the eighth capacitor and the ninth capacitor One end is connected and its connection end is connected to 5V voltage, the third pin of the voltage regulator chip, one end of the tenth capacitor and one end of the eleventh capacitor are connected and the connection end outputs 3.3V voltage, The other end of the eighth capacitor, the other end of the ninth capacitor, the other end of the tenth capacitor and the other end of the eleventh capacitor are all grounded;
所述的第十二电容的一端、所述的第一晶振的第2脚和所述的控制芯片的第12脚连接,所述的第十二电容的另一端和所述的第十三电容的一端均接地,所述的第十三电容的另一端、所述的第一晶振的第1脚和所述的第二电阻的一端连接,所述的第二电阻的另一端和所述的控制芯片的第13脚连接;One end of the twelfth capacitor, the second pin of the first crystal oscillator and the twelfth pin of the control chip are connected, the other end of the twelfth capacitor is connected to the thirteenth capacitor One end of both is grounded, the other end of the thirteenth capacitor, the first pin of the first crystal oscillator is connected to one end of the second resistor, the other end of the second resistor is connected to the The 13th pin connection of the control chip;
所述的第十四电容的一端、所述的第二晶振的第2脚和所述的控制芯片的第8脚连接,所述的第十四电容的另一端和所述的第十五电容的一端均接地,所述的第十五电容的另一端、所述的第二晶振的第1脚和所述的控制芯片的第9脚连接;One end of the fourteenth capacitor, the second pin of the second crystal oscillator and the eighth pin of the control chip are connected, the other end of the fourteenth capacitor is connected to the fifteenth capacitor One end of both is grounded, the other end of the fifteenth capacitor, the first pin of the second crystal oscillator and the ninth pin of the control chip are connected;
所述的第十六电容的一端、所述的第十七电容的一端、所述的第十八电容的一端、所述的第十九电容的一端、所述的第二十电容的一端、所述的第二十一电容的一端和所述的第二十二电容的一端连接且其连接端接入3.3V电压,所述的第十六电容的另一端、所述的第十七电容的另一端、所述的第十八电容的另一端、所述的第十九电容的另一端、所述的第二十电容的另一端、所述的第二十一电容的另一端和所述的第二十二电容的另一端均接地;One end of the sixteenth capacitor, one end of the seventeenth capacitor, one end of the eighteenth capacitor, one end of the nineteenth capacitor, one end of the twentieth capacitor, One end of the twenty-first capacitor is connected to one end of the twenty-second capacitor and its connection end is connected to a 3.3V voltage, the other end of the sixteenth capacitor, the seventeenth capacitor the other end of the eighteenth capacitor, the other end of the nineteenth capacitor, the other end of the twentieth capacitor, the other end of the twenty-first capacitor and the The other end of the twenty-second capacitor mentioned above is all grounded;
所述的第三电阻的一端接入3.3V电压,所述的第三电阻的另一端、所述的连接端子的第2脚和所述的控制芯片的第94脚连接,所述的连接端子的第1脚接地;所述的第四电阻的一端接入3.3V电压,所述的第四电阻的另一端、所述的第二十三电容的一端、所述的按键的一端和所述的控制芯片的第14脚连接,所述的按键的另一端和所述的第二十三电容的另一端均接地;One end of the third resistor is connected to 3.3V voltage, the other end of the third resistor, the second pin of the connecting terminal is connected to the 94th pin of the control chip, and the connecting terminal The first pin of the ground is grounded; one end of the fourth resistor is connected to a 3.3V voltage, the other end of the fourth resistor, one end of the twenty-third capacitor, one end of the button and the The 14th pin of the control chip is connected, and the other end of the button and the other end of the twenty-third capacitor are grounded;
所述的控制芯片的第47脚和所述的电感数字转换器的第16脚连接,所述的控制芯片的第48脚和所述的电感数字转换器的第14脚连接,所述的控制芯片的第51脚和所述的电感数字转换器的第2脚连接,所述的控制芯片的第52脚和所述的电感数字转换器的第1脚连接,所述的控制芯片的第53脚和所述的电感数字转换器的第5脚连接,所述的控制芯片的第54脚和所述的电感数字转换器的第3脚连接,所述的控制芯片的第6脚、第11脚、第28脚、第50脚、第75脚和第100脚均接入3.3V电压,所述的控制芯片的第10脚、第27脚、第49脚、第74脚和第99脚均接地。The 47th pin of the control chip is connected to the 16th pin of the inductance-to-digital converter, the 48th pin of the control chip is connected to the 14th pin of the inductance-to-digital converter, and the control The 51st pin of the chip is connected to the 2nd pin of the inductance-to-digital converter, the 52nd pin of the control chip is connected to the 1st pin of the inductance-to-digital converter, and the 53rd pin of the control chip The pin is connected to the 5th pin of the inductance-to-digital converter, the 54th pin of the control chip is connected to the 3rd pin of the inductance-to-digital converter, the 6th pin, the 11th pin of the control chip Pin, 28th pin, 50th pin, 75th pin and 100th pin are all connected to 3.3V voltage, and the 10th pin, 27th pin, 49th pin, 74th pin and 99th pin of the control chip are connected grounded.
与现有技术相比,本发明的方法优点在于通过设置感应线圈和检测电路,基于感应线圈与导电材料靠近时会产生电磁感应现象,感应线圈的损耗电阻和谐振频率的大小会发生改变的原理,控制器中存储有感应线圈伸到边界上方时的损耗电阻或谐振频率对应的参考值范围,检测电路实时获取感应线圈的损耗电阻或谐振频率,并将损耗电阻或谐振频率转化为实时数字信号后发送给控制器,控制器将实时数字信号的值与参考值范围进行对比,如果实时数字信号的值落入参考值范围内,则移动机器人到达边界,实时获取感应线圈损耗电阻或谐振频率即可确定边界,由此仅需采用导电材料作为无源边界,边界材料选择的范围广,并且不需要额外配备信号发生器,成本较低,在移动机器人进入边界时,调整移动机器人进入工作区域的移动方向使其移动方向垂直于进入处边界,当移动机器人到达相对的边界或者左右两边的边界时,控制器根据移动机器人达到的边界改变计划任务,驱动使得移动机器人调整方向,回到工作区域内,如此往复,使移动机器人在工作区域内往复工作,由此实现移动机器人工作的引导,操作简单且精度较高。Compared with the prior art, the advantage of the method of the present invention is that by setting the induction coil and the detection circuit, based on the principle that the electromagnetic induction phenomenon will occur when the induction coil is close to the conductive material, the loss resistance of the induction coil and the size of the resonance frequency will change. , the controller stores the reference value range corresponding to the loss resistance or resonance frequency when the induction coil extends above the boundary, the detection circuit obtains the loss resistance or resonance frequency of the induction coil in real time, and converts the loss resistance or resonance frequency into a real-time digital signal After sending it to the controller, the controller compares the value of the real-time digital signal with the reference value range. If the value of the real-time digital signal falls within the reference value range, the mobile robot reaches the boundary and obtains the loss resistance of the induction coil or the resonance frequency in real time. The boundary can be determined, so only conductive materials need to be used as the passive boundary, the boundary material can be selected in a wide range, and no additional signal generator is required, and the cost is low. When the mobile robot enters the boundary, adjust the movement of the mobile robot into the working area The moving direction makes the moving direction perpendicular to the entry boundary. When the mobile robot reaches the opposite boundary or the left and right boundaries, the controller changes the planned task according to the boundary reached by the mobile robot, and drives the mobile robot to adjust its direction and return to the working area. , reciprocate in this way, so that the mobile robot reciprocates in the working area, thereby realizing the guidance of the mobile robot's work, with simple operation and high precision.
附图说明Description of drawings
图1为本发明的信号探测器的电路图;Fig. 1 is the circuit diagram of signal detector of the present invention;
图2为本发明的控制器的电路图;Fig. 2 is the circuit diagram of controller of the present invention;
图3为本发明的方法中移动机器人的结构示意图;Fig. 3 is the structural representation of mobile robot in the method of the present invention;
图4为本发明的界定方法中移动机器人的行进示意图;Fig. 4 is the traveling schematic diagram of mobile robot in the definition method of the present invention;
图5为本发明的界定方法中移动机器人沿界行进的示意图。Fig. 5 is a schematic diagram of the mobile robot moving along the boundary in the definition method of the present invention.
具体实施方式detailed description
以下结合附图实施例对本发明作进一步详细描述。The present invention will be further described in detail below in conjunction with the accompanying drawings and embodiments.
本发明公开了一种用于界定移动机器人工作区域的装置,包括控制器和至少一个信号探测器,控制器和信号探测器安装在移动机器人上,信号探测器包括用于和导电材料的边界产生电磁感应现象的感应线圈L1和用于获取感应线圈L1的损耗电阻或谐振频率的检测电路,感应线圈L1的在移动机器人上的位置高于边界,控制器中存储有感应线圈L1伸到边界上方时的损耗电阻或谐振频率对应的参考值范围,检测电路实时获取感应线圈L1的损耗电阻或谐振频率,并将损耗电阻或谐振频率转化为实时数字信号后发送给控制器,控制器将实时数字信号的值与参考值范围进行对比,如果实时数字信号的值落入参考值范围内,则移动机器人到达边界。The invention discloses a device for defining the working area of a mobile robot, comprising a controller and at least one signal detector, the controller and the signal detector are installed on the mobile robot, and the signal detector includes a device for generating a boundary with a conductive material The induction coil L1 of the electromagnetic induction phenomenon and the detection circuit used to obtain the loss resistance or resonance frequency of the induction coil L1, the position of the induction coil L1 on the mobile robot is higher than the boundary, and the induction coil L1 is stored above the boundary in the controller The reference value range corresponding to the loss resistance or resonant frequency at time, the detection circuit obtains the loss resistance or resonant frequency of the induction coil L1 in real time, converts the loss resistance or resonant frequency into a real-time digital signal and sends it to the controller, and the controller converts the real-time digital signal The value of the signal is compared with a reference value range, and if the value of the real-time digital signal falls within the reference value range, the mobile robot has reached the boundary.
实施例:一种用于界定移动机器人工作区域的装置,包括控制器和至少一个信号探测器,控制器和信号探测器安装在移动机器人上,信号探测器包括用于和导电材料的边界产生电磁感应现象的感应线圈L1和用于获取感应线圈L1的损耗电阻或谐振频率的检测电路,感应线圈L1的在移动机器人上的位置高于边界,控制器中存储有感应线圈L1伸到边界上方时的损耗电阻或谐振频率对应的参考值范围Vmin~Vmax,检测电路实时获取感应线圈L1的损耗电阻或谐振频率,并将损耗电阻或谐振频率转化为实时数字信号后发送给控制器,控制器将实时数字信号的值与参考值范围进行对比,如果实时数字信号的值落入参考值范围内,则移动机器人到达边界。Embodiment: A device for defining the working area of a mobile robot, including a controller and at least one signal detector, the controller and the signal detector are installed on the mobile robot, and the signal detector includes a The induction coil L1 of the magnetic induction phenomenon and the detection circuit used to obtain the loss resistance or resonance frequency of the induction coil L1, the position of the induction coil L1 on the mobile robot is higher than the boundary, and the controller stores when the induction coil L1 extends above the boundary The reference value range Vmin~Vmax corresponding to the loss resistance or resonant frequency of the induction coil L1 in real time, the detection circuit obtains the loss resistance or resonant frequency of the induction coil L1 in real time, and converts the loss resistance or resonant frequency into real-time digital signals and sends them to the controller. The value of the real-time digital signal is compared with the reference value range, and if the value of the real-time digital signal falls within the reference value range, the mobile robot reaches the boundary.
本实施例中,参考数字信号范围中Vmin为感应线圈L1开始进入边界上方时损耗电阻或谐振频率对应的数字信号的大小,Vmax为感应线圈L1完全进入边界上方时损耗电阻或谐振频率对应的数字信号的大小。In this embodiment, Vmin in the reference digital signal range is the size of the digital signal corresponding to the loss resistance or resonance frequency when the induction coil L1 starts to enter above the boundary, and Vmax is the loss resistance or the number corresponding to the resonance frequency when the induction coil L1 completely enters the boundary. the size of the signal.
本实施例中,边界的材料来源广泛,可以是低成本的压箔,也可以是常见的铁丝,只要是一般的导体都可用于边界的建立。In this embodiment, the material of the boundary comes from a wide range of sources, such as low-cost pressed foil or common iron wire, as long as it is a common conductor, it can be used to establish the boundary.
本实施例中,如图1所示,检测电路包括电感数字转换器U1、第一电容C1、第二电容C2、第三电容C3、第四电容C4、第五电容C5、第六电容C6和第七电容C7,电感数字转换器U1的型号为LDC1000、LDC1041或LDC1051,电感数字转换器U1的第4脚、第一电容C1的一端和第二电容C2的一端连接且其连接端接入3.3V电压,第一电容C1的另一端和第二电容C2的另一端均接地,电感数字转换器U1的第13脚和第三电容C3的一端连接,第三电容C3的另一端接地,电感数字转换器U1的第7脚和第四电容C4的一端连接,第四电容C4的另一端和电感数字转换器U1的第8脚连接,电感数字转换器U1的第11脚和第17脚均接模拟地,电感数字转化器的第9脚、第七电容C7的一端和感应线圈L1的一端连接,电感数字转换器U1的第10脚、第七电容C7的另一端和感应线圈L1的另一端连接,电感数字转换器U1的第12脚、第五电容C5的一端和第六电容C6的一端连接且其连接端接入5V电压,第五电容C5的另一端和第六电容C6的另一端均接模拟地,电感数字转换器U1的第1脚、第2脚、第3脚、第5脚、第14脚和第16脚分别与控制器连接。In this embodiment, as shown in FIG. 1 , the detection circuit includes an inductance-to-digital converter U1, a first capacitor C1, a second capacitor C2, a third capacitor C3, a fourth capacitor C4, a fifth capacitor C5, a sixth capacitor C6 and The seventh capacitor C7, the model of the inductance-to-digital converter U1 is LDC1000, LDC1041 or LDC1051, the 4th pin of the inductance-to-digital converter U1, one end of the first capacitor C1 and one end of the second capacitor C2 are connected and its connection end is connected to 3.3 V voltage, the other end of the first capacitor C1 and the other end of the second capacitor C2 are both grounded, the 13th pin of the inductance-to-digital converter U1 is connected to one end of the third capacitor C3, the other end of the third capacitor C3 is grounded, and the inductance digital The 7th pin of the converter U1 is connected to one end of the fourth capacitor C4, the other end of the fourth capacitor C4 is connected to the 8th pin of the inductance-to-digital converter U1, and the 11th and 17th pins of the inductance-to-digital converter U1 are both connected to Analog ground, the 9th pin of the inductance-to-digital converter, one end of the seventh capacitor C7, and one end of the induction coil L1 are connected, the tenth pin of the inductance-to-digital converter U1, the other end of the seventh capacitor C7, and the other end of the induction coil L1 Connection, the 12th pin of the inductance-to-digital converter U1, one end of the fifth capacitor C5 and one end of the sixth capacitor C6 are connected and the connection end is connected to a 5V voltage, the other end of the fifth capacitor C5 is connected to the other end of the sixth capacitor C6 All are connected to the analog ground, and pins 1, 2, 3, 5, 14 and 16 of the inductance-to-digital converter U1 are respectively connected to the controller.
本实施例中,如图2所示,控制器包括为型号为STM32F103的控制芯片U2、型号为SPX1117的稳压芯片M1、第一电阻R1、第二电阻R2、第三电阻R3、第四电阻R4、第八电容C8、第九电容C9、第十电容C10、第十一电容C11、第十二电容C12、第十三电容C13、第十四电容C14、第十五电容C15、第十六电容C16、第十七电容C17、第十八电容C18、第十九电容C19、第二十电容C20、第二十一电容C21、第二十二电容C22、第二十三电容C23、第一晶振Y1、第二晶振Y2、按键S1和连接端子P1;In this embodiment, as shown in FIG. 2 , the controller includes a control chip U2 whose model is STM32F103, a voltage regulator chip M1 whose model is SPX1117, a first resistor R1, a second resistor R2, a third resistor R3, and a fourth resistor R4, eighth capacitor C8, ninth capacitor C9, tenth capacitor C10, eleventh capacitor C11, twelfth capacitor C12, thirteenth capacitor C13, fourteenth capacitor C14, fifteenth capacitor C15, sixteenth capacitor Capacitor C16, seventeenth capacitor C17, eighteenth capacitor C18, nineteenth capacitor C19, twentieth capacitor C20, twenty-first capacitor C21, twenty-second capacitor C22, twenty-third capacitor C23, first Crystal oscillator Y1, second crystal oscillator Y2, button S1 and connecting terminal P1;
第一电阻R1的一端接地,第一电阻R1的另一端接模拟地,稳压芯片M1的第2脚、第八电容C8的一端和第九电容C9的一端连接且其连接端接入5V电压,稳压芯片M1的第3脚、第十电容C10的一端和第十一电容C11的一端连接且其连接端输出3.3V电压,第八电容C8的另一端、第九电容C9的另一端、第十电容C10的另一端和第十一电容C11的另一端均接地;One end of the first resistor R1 is grounded, the other end of the first resistor R1 is connected to the analog ground, the second pin of the voltage regulator chip M1, one end of the eighth capacitor C8 and one end of the ninth capacitor C9 are connected, and the connecting end is connected to 5V voltage , the third pin of the voltage regulator chip M1, one end of the tenth capacitor C10 and one end of the eleventh capacitor C11 are connected and the connecting end outputs a voltage of 3.3V, the other end of the eighth capacitor C8, the other end of the ninth capacitor C9, The other end of the tenth capacitor C10 and the other end of the eleventh capacitor C11 are grounded;
第十二电容C12的一端、第一晶振Y1的第2脚和控制芯片U2的第12脚连接,第十二电容C12的另一端和第十三电容C13的一端均接地,第十三电容C13的另一端、第一晶振Y1的第1脚和第二电阻R2的一端连接,第二电阻R2的另一端和控制芯片U2的第13脚连接;One end of the twelfth capacitor C12, the second pin of the first crystal oscillator Y1 and the twelfth pin of the control chip U2 are connected, the other end of the twelfth capacitor C12 and one end of the thirteenth capacitor C13 are grounded, and the thirteenth capacitor C13 The other end of the first crystal oscillator Y1 is connected to one end of the second resistor R2, and the other end of the second resistor R2 is connected to the 13th pin of the control chip U2;
第十四电容C14的一端、第二晶振Y2的第2脚和控制芯片U2的第8脚连接,第十四电容C14的另一端和第十五电容C15的一端均接地,第十五电容C15的另一端、第二晶振Y2的第1脚和控制芯片U2的第9脚连接;One end of the fourteenth capacitor C14, the second pin of the second crystal oscillator Y2 and the eighth pin of the control chip U2 are connected, the other end of the fourteenth capacitor C14 and one end of the fifteenth capacitor C15 are grounded, and the fifteenth capacitor C15 The other end of the second crystal oscillator Y2 is connected to the 9th pin of the control chip U2;
第十六电容C16的一端、第十七电容C17的一端、第十八电容C18的一端、第十九电容C19的一端、第二十电容C20的一端、第二十一电容C21的一端和第二十二电容C22的一端连接且其连接端接入3.3V电压,第十六电容C16的另一端、第十七电容C17的另一端、第十八电容C18的另一端、第十九电容C19的另一端、第二十电容C20的另一端、第二十一电容C21的另一端和第二十二电容C22的另一端均接地;One end of the sixteenth capacitor C16, one end of the seventeenth capacitor C17, one end of the eighteenth capacitor C18, one end of the nineteenth capacitor C19, one end of the twentieth capacitor C20, one end of the twenty-first capacitor C21 and the One end of the twenty-second capacitor C22 is connected and its connection end is connected to 3.3V voltage, the other end of the sixteenth capacitor C16, the other end of the seventeenth capacitor C17, the other end of the eighteenth capacitor C18, and the nineteenth capacitor C19 The other end of the twentieth capacitor C20, the other end of the twenty-first capacitor C21 and the other end of the twenty-second capacitor C22 are all grounded;
第三电阻R3的一端接入3.3V电压,第三电阻R3的另一端、连接端子P1的第2脚和控制芯片U2的第94脚连接,连接端子P1的第1脚接地;第四电阻R4的一端接入3.3V电压,第四电阻R4的另一端、第二十三电容C23的一端、按键S1的一端和控制芯片U2的第14脚连接,按键S1的另一端和第二十三电容C23的另一端均接地;One end of the third resistor R3 is connected to 3.3V voltage, the other end of the third resistor R3, the second pin of the connection terminal P1 is connected to the 94th pin of the control chip U2, and the first pin of the connection terminal P1 is grounded; the fourth resistor R4 One end of the fourth resistor R4 is connected to the 3.3V voltage, the other end of the fourth resistor R4, one end of the twenty-third capacitor C23, one end of the button S1 is connected to the 14th pin of the control chip U2, and the other end of the button S1 is connected to the twenty-third capacitor The other end of C23 is grounded;
控制芯片U2的第47脚和电感数字转换器U1的第16脚连接,控制芯片U2的第48脚和电感数字转换器U1的第14脚连接,控制芯片U2的第51脚和电感数字转换器U1的第2脚连接,控制芯片U2的第52脚和电感数字转换器U1的第1脚连接,控制芯片U2的第53脚和电感数字转换器U1的第5脚连接,控制芯片U2的第54脚和电感数字转换器U1的第3脚连接,控制芯片U2的第6脚、第11脚、第28脚、第50脚、第75脚和第100脚均接入3.3V电压,控制芯片U2的第10脚、第27脚、第49脚、第74脚和第99脚均接地。The 47th pin of the control chip U2 is connected to the 16th pin of the inductance-to-digital converter U1, the 48th pin of the control chip U2 is connected to the 14th pin of the inductance-to-digital converter U1, and the 51st pin of the control chip U2 is connected to the inductance-to-digital converter The 2nd pin of U1 is connected, the 52nd pin of the control chip U2 is connected with the 1st pin of the inductance-to-digital converter U1, the 53rd pin of the control chip U2 is connected with the 5th pin of the inductance-to-digital converter U1, and the 5th pin of the control chip U2 Pin 54 is connected to pin 3 of inductance-to-digital converter U1, pin 6, pin 11, pin 28, pin 50, pin 75 and pin 100 of the control chip U2 are all connected to 3.3V voltage, and the control chip The 10th, 27th, 49th, 74th and 99th pins of U2 are all grounded.
本发明还公开了一种上述用于界定移动机器人工作区域的装置的界定方法,信号探测器的数量为两个,两个信号探测器的感应线圈L1并行设置在移动机器人上,如图3所示。以下结合具体实施例进行说明。The present invention also discloses a method for defining the above-mentioned device for defining the working area of a mobile robot. The number of signal detectors is two, and the induction coils L1 of the two signal detectors are arranged on the mobile robot in parallel, as shown in FIG. 3 Show. The following will be described in conjunction with specific embodiments.
实施例:一种用于界定移动机器人工作区域的装置的界定方法,工作区域由边界围成方形,边界的材料来源广泛,可以是低成本的压箔,也可以是常见的铁丝,具体包括以下步骤:Embodiment: A method for defining a device for defining the working area of a mobile robot. The working area is surrounded by a square border, and the border material has a wide range of sources, which can be low-cost pressed foil or common iron wire, specifically including the following step:
①将控制器和信号探测器进行初始化;① Initialize the controller and signal detector;
②将感应线圈L1伸到边界上方时的损耗电阻或谐振频率对应的参考值范围Vmin~Vmax存入到控制器中,其中Vmin为感应线圈L1开始进入边界上方时损耗电阻或谐振频率对应的数字信号的大小,Vmax为感应线圈L1完全进入边界上方时损耗电阻或谐振频率对应的数字信号的大小;② Store the reference value range Vmin~Vmax corresponding to the loss resistance or resonance frequency when the induction coil L1 extends above the boundary into the controller, where Vmin is the loss resistance or the number corresponding to the resonance frequency when the induction coil L1 starts to enter above the boundary The size of the signal, Vmax is the size of the digital signal corresponding to the loss resistance or the resonance frequency when the induction coil L1 completely enters the boundary;
③调整移动机器人进入工作区域的移动方向:③Adjust the moving direction of the mobile robot into the working area:
③-1控制器驱动移动机器人经一条边界进入工作区域,两个检测电路实时获取感应线圈L1的损耗电阻或谐振频率,并将损耗电阻或谐振频率转化为实时数字信号后发送给控制器,将两个检测电路实时获取的损耗电阻或谐振频率对应的数字信号记为V1和V2;③-1 The controller drives the mobile robot to enter the working area through a boundary, and the two detection circuits obtain the loss resistance or resonance frequency of the induction coil L1 in real time, and convert the loss resistance or resonance frequency into a real-time digital signal and send it to the controller. The digital signals corresponding to the loss resistance or resonance frequency obtained by the two detection circuits in real time are denoted as V1 and V2;
③-2如果V1和V2中有一个先落入Vmin~Vmax范围内,则控制器驱动移动机器人调整移动方向至V1和V2均落入Vmin~Vmax范围内且大小相等;如果V1和V2同时落入Vmin~Vmax范围内时,如果V1和V2相等,则移动机器人移动方向不用调整,如果V1和V2不相等,则控制器驱动移动机器人调整移动方向至V1和V2大小相等且均落入Vmin~Vmax范围内,此时移动机器人在工作区域的移动方向垂直于进入处边界;③-2 If one of V1 and V2 falls within the range of Vmin~Vmax first, the controller drives the mobile robot to adjust the moving direction until both V1 and V2 fall within the range of Vmin~Vmax and are equal in size; When entering the range of Vmin~Vmax, if V1 and V2 are equal, the moving direction of the mobile robot does not need to be adjusted. If V1 and V2 are not equal, the controller drives the mobile robot to adjust the moving direction until V1 and V2 are equal in size and fall into Vmin~ Within the range of Vmax, at this time, the moving direction of the mobile robot in the working area is perpendicular to the boundary of the entry point;
④控制移动机器人在工作区域的右边区域遍历,具体过程为:④ Control the mobile robot to traverse in the right area of the working area, the specific process is:
④-1移动机器人沿垂直于进入处边界的方向向前移动,两个检测电路实时获取感应线圈L1的损耗电阻或谐振频率,并将损耗电阻或谐振频率转化为数字信号后发送给控制器,控制器将实时数字信号的值与参考值范围Vmin~Vmax进行对比,如果实时数字信号的值落入参考值范围内,则移动机器人到达与进入处边界相对的边界;④-1 The mobile robot moves forward in a direction perpendicular to the boundary of the entry point. The two detection circuits obtain the loss resistance or resonance frequency of the induction coil L1 in real time, and convert the loss resistance or resonance frequency into a digital signal and send it to the controller. The controller compares the value of the real-time digital signal with the reference value range Vmin~Vmax, and if the value of the real-time digital signal falls within the reference value range, the mobile robot reaches the boundary opposite to the boundary of the entry point;
④-2当移动机器人到达与进入处边界相对的边界处时,控制器控制移动机器人顺时针转动90度后平行于与进入处边界相对的边界的方向向前移动一段距离d,d等于移动机器人的工作宽度(比如割草用移动机器人中d为割草刀具的长度,扫地用移动机器人中d为吸尘设备的吸附距离),然后再顺时针转动90度向前移动;④-2 When the mobile robot reaches the boundary opposite to the entry boundary, the controller controls the mobile robot to turn 90 degrees clockwise and then move forward for a distance d parallel to the direction of the boundary opposite to the entry boundary, where d is equal to the mobile robot The working width (for example, d in the mobile robot for mowing is the length of the mowing tool, and d in the mobile robot for sweeping the floor is the suction distance of the dust collection equipment), and then rotate 90 degrees clockwise to move forward;
④-3每次遇到与进入处边界相对的边界后,都重复步骤④-2,并统计移动机器人沿平行于与进入处边界相对的边界的方向向前移动的次数,将该次数记为n;当移动机器人在沿平行于与进入处边界相对的边界移动时到达右边边界时,停止移动,控制移动机器人顺时针转动90度后向前移动至边界处,完成右边区域遍历;④-3 Repeat step ④-2 every time it encounters the boundary opposite to the boundary of the entry point, and count the number of times the mobile robot moves forward along the direction parallel to the boundary opposite to the boundary of the entry point, and record the number of times as n; when the mobile robot reaches the right boundary while moving along the boundary parallel to the boundary opposite to the entry boundary, stop moving, control the mobile robot to rotate clockwise 90 degrees and then move forward to the boundary to complete the traversal of the right area;
⑤控制移动机器人在右边边界处顺时针转动90度后垂直于右边边界的方向移动大小为n*d的距离后再顺时针转动90度,此时移动机器人的移动方向垂直于进入处边界;⑤Control the mobile robot to rotate 90 degrees clockwise at the right boundary, and then move a distance of n*d perpendicular to the right boundary, and then rotate 90 degrees clockwise. At this time, the moving direction of the mobile robot is perpendicular to the boundary of the entry place;
⑥控制移动机器人在工作区域的左边区域遍历,具体过程为:⑥Control the mobile robot to traverse in the left area of the working area, the specific process is:
⑥-1移动机器人沿垂直于进入处边界的方向向前移动,两个检测电路实时获取所述的感应线圈L1的损耗电阻或谐振频率,并将损耗电阻或谐振频率转化为实时数字信号后发送给控制器,控制器将实时数字信号与参考值范围Vmin~Vmax进行对比,如果实时数字信号的值落入参考值范围内,则移动机器人到达与进入处边界相对的边界;⑥-1 The mobile robot moves forward along the direction perpendicular to the boundary of the entrance, and the two detection circuits obtain the loss resistance or resonance frequency of the induction coil L1 in real time, and convert the loss resistance or resonance frequency into a real-time digital signal and send it to To the controller, the controller compares the real-time digital signal with the reference value range Vmin~Vmax, if the value of the real-time digital signal falls within the reference value range, the mobile robot reaches the boundary opposite to the boundary of the entry point;
⑥-2当移动机器人到达与进入处边界相对的边界处时,控制器控制移动机器人逆时针转动90度后沿平行于与进入处边界相对的边界的方向向前移动一段距离d,d等于移动机器人的工作宽度,然后再逆时针转动90度向前移动;⑥-2 When the mobile robot reaches the boundary opposite to the entry boundary, the controller controls the mobile robot to turn 90 degrees counterclockwise and then move forward for a distance d in a direction parallel to the boundary opposite to the entry boundary, where d is equal to the movement The working width of the robot, and then turn 90 degrees counterclockwise to move forward;
⑥-3每次遇到与进入处边界相对的边界后,都重复步骤⑥-2,当移动机器人在沿平行于与进入处边界相对的边界移动时到达左边边界时,停止移动,控制移动机器人逆时针转动90度后向前移动至边界处,完成左边区域遍历。⑥-3 Repeat step ⑥-2 every time when encountering the boundary opposite to the boundary of the entry point. When the mobile robot reaches the left boundary while moving along the boundary parallel to the boundary opposite to the entry point, stop moving and control the mobile robot After turning 90 degrees counterclockwise, move forward to the boundary to complete the traversal of the left area.
本实施例中,编码器采用其技术领域的成熟产品。如图4所示,移动机器人1在工作区域2内根据所计划的任务,按一定方式运动,当进入工作区域2时,通过两个检测电路,矫正移动机器人1相对边界3的位置,使其矫正到垂直于进入处边界31的状态。检测电路实检测感应线圈L1的损耗电阻或谐振频率并将对应的信号传送给控制器,当移动机器人遇到与边界31相对的边界32时,感应线圈L1磁场信号的变化,检测电路检测到感应线圈L1变化的损耗电阻或谐振频率,将对应的信号发送给控制器,控制器判定移动机器人达到边界处,改变计划任务,驱动使得移动机器人1掉头,回到工作区域内,如此往复,使移动机器人1在工作区域内往复工作。In this embodiment, the encoder adopts a mature product in its technical field. As shown in Figure 4, the mobile robot 1 moves in a certain way in the working area 2 according to the planned tasks. When entering the working area 2, the position of the mobile robot 1 relative to the boundary 3 is corrected by two detection circuits so that Correct to a state perpendicular to the boundary 31 at the entry point. The detection circuit actually detects the loss resistance or resonance frequency of the induction coil L1 and transmits the corresponding signal to the controller. When the mobile robot encounters the boundary 32 opposite to the boundary 31, the detection circuit detects the change of the magnetic field signal of the induction coil L1. The loss resistance or resonant frequency of coil L1 changes, and the corresponding signal is sent to the controller. The controller determines that the mobile robot has reached the boundary, changes the planned task, and drives the mobile robot 1 to turn around and return to the working area. The robot 1 works reciprocally in the working area.
本实施例中,如图1所示,检测电路包括电感数字转换器U1、第一电容C1、第二电容C2、第三电容C3、第四电容C4、第五电容C5、第六电容C6和第七电容C7,电感数字转换器U1的型号为LDC1000、LDC1041或LDC1051,电感数字转换器U1的第4脚、第一电容C1的一端和第二电容C2的一端连接且其连接端接入3.3V电压,第一电容C1的另一端和第二电容C2的另一端均接地,电感数字转换器U1的第13脚和第三电容C3的一端连接,第三电容C3的另一端接地,电感数字转换器U1的第7脚和第四电容C4的一端连接,第四电容C4的另一端和电感数字转换器U1的第8脚连接,电感数字转换器U1的第11脚和第17脚均接模拟地,电感数字转化器的第9脚、第七电容C7的一端和感应线圈L1的一端连接,电感数字转换器U1的第10脚、第七电容C7的另一端和感应线圈L1的另一端连接,电感数字转换器U1的第12脚、第五电容C5的一端和第六电容C6的一端连接且其连接端接入5V电压,第五电容C5的另一端和第六电容C6的另一端均接模拟地,电感数字转换器U1的第1脚、第2脚、第3脚、第5脚、第14脚和第16脚分别与控制器连接。In this embodiment, as shown in FIG. 1 , the detection circuit includes an inductance-to-digital converter U1, a first capacitor C1, a second capacitor C2, a third capacitor C3, a fourth capacitor C4, a fifth capacitor C5, a sixth capacitor C6 and The seventh capacitor C7, the model of the inductance-to-digital converter U1 is LDC1000, LDC1041 or LDC1051, the 4th pin of the inductance-to-digital converter U1, one end of the first capacitor C1 and one end of the second capacitor C2 are connected and its connection end is connected to 3.3 V voltage, the other end of the first capacitor C1 and the other end of the second capacitor C2 are both grounded, the 13th pin of the inductance-to-digital converter U1 is connected to one end of the third capacitor C3, the other end of the third capacitor C3 is grounded, and the inductance digital The 7th pin of the converter U1 is connected to one end of the fourth capacitor C4, the other end of the fourth capacitor C4 is connected to the 8th pin of the inductance-to-digital converter U1, and the 11th and 17th pins of the inductance-to-digital converter U1 are both connected to Analog ground, the 9th pin of the inductance-to-digital converter, one end of the seventh capacitor C7, and one end of the induction coil L1 are connected, the tenth pin of the inductance-to-digital converter U1, the other end of the seventh capacitor C7, and the other end of the induction coil L1 Connection, the 12th pin of the inductance-to-digital converter U1, one end of the fifth capacitor C5 and one end of the sixth capacitor C6 are connected and the connection end is connected to a 5V voltage, the other end of the fifth capacitor C5 is connected to the other end of the sixth capacitor C6 All are connected to the analog ground, and pins 1, 2, 3, 5, 14 and 16 of the inductance-to-digital converter U1 are respectively connected to the controller.
本实施例中,如图2所示,控制器包括为型号为STM32F103的控制芯片U2、型号为SPX1117的稳压芯片M1、第一电阻R1、第二电阻R2、第三电阻R3、第四电阻R4、第八电容C8、第九电容C9、第十电容C10、第十一电容C11、第十二电容C12、第十三电容C13、第十四电容C14、第十五电容C15、第十六电容C16、第十七电容C17、第十八电容C18、第十九电容C19、第二十电容C20、第二十一电容C21、第二十二电容C22、第二十三电容C23、第一晶振Y1、第二晶振Y2、按键S1和连接端子P1;In this embodiment, as shown in FIG. 2 , the controller includes a control chip U2 whose model is STM32F103, a voltage regulator chip M1 whose model is SPX1117, a first resistor R1, a second resistor R2, a third resistor R3, and a fourth resistor R4, eighth capacitor C8, ninth capacitor C9, tenth capacitor C10, eleventh capacitor C11, twelfth capacitor C12, thirteenth capacitor C13, fourteenth capacitor C14, fifteenth capacitor C15, sixteenth capacitor Capacitor C16, seventeenth capacitor C17, eighteenth capacitor C18, nineteenth capacitor C19, twentieth capacitor C20, twenty-first capacitor C21, twenty-second capacitor C22, twenty-third capacitor C23, first Crystal oscillator Y1, second crystal oscillator Y2, button S1 and connecting terminal P1;
第一电阻R1的一端接地,第一电阻R1的另一端接模拟地,稳压芯片M1的第2脚、第八电容C8的一端和第九电容C9的一端连接且其连接端接入5V电压,稳压芯片M1的第3脚、第十电容C10的一端和第十一电容C11的一端连接且其连接端输出3.3V电压,第八电容C8的另一端、第九电容C9的另一端、第十电容C10的另一端和第十一电容C11的另一端均接地;One end of the first resistor R1 is grounded, the other end of the first resistor R1 is connected to the analog ground, the second pin of the voltage regulator chip M1, one end of the eighth capacitor C8 and one end of the ninth capacitor C9 are connected, and the connecting end is connected to 5V voltage , the third pin of the voltage regulator chip M1, one end of the tenth capacitor C10 and one end of the eleventh capacitor C11 are connected and the connecting end outputs a voltage of 3.3V, the other end of the eighth capacitor C8, the other end of the ninth capacitor C9, The other end of the tenth capacitor C10 and the other end of the eleventh capacitor C11 are grounded;
第十二电容C12的一端、第一晶振Y1的第2脚和控制芯片U2的第12脚连接,第十二电容C12的另一端和第十三电容C13的一端均接地,第十三电容C13的另一端、第一晶振Y1的第1脚和第二电阻R2的一端连接,第二电阻R2的另一端和控制芯片U2的第13脚连接;One end of the twelfth capacitor C12, the second pin of the first crystal oscillator Y1 and the twelfth pin of the control chip U2 are connected, the other end of the twelfth capacitor C12 and one end of the thirteenth capacitor C13 are grounded, and the thirteenth capacitor C13 The other end of the first crystal oscillator Y1 is connected to one end of the second resistor R2, and the other end of the second resistor R2 is connected to the 13th pin of the control chip U2;
第十四电容C14的一端、第二晶振Y2的第2脚和控制芯片U2的第8脚连接,第十四电容C14的另一端和第十五电容C15的一端均接地,第十五电容C15的另一端、第二晶振Y2的第1脚和控制芯片U2的第9脚连接;One end of the fourteenth capacitor C14, the second pin of the second crystal oscillator Y2 and the eighth pin of the control chip U2 are connected, the other end of the fourteenth capacitor C14 and one end of the fifteenth capacitor C15 are grounded, and the fifteenth capacitor C15 The other end of the second crystal oscillator Y2 is connected to the 9th pin of the control chip U2;
第十六电容C16的一端、第十七电容C17的一端、第十八电容C18的一端、第十九电容C19的一端、第二十电容C20的一端、第二十一电容C21的一端和第二十二电容C22的一端连接且其连接端接入3.3V电压,第十六电容C16的另一端、第十七电容C17的另一端、第十八电容C18的另一端、第十九电容C19的另一端、第二十电容C20的另一端、第二十一电容C21的另一端和第二十二电容C22的另一端均接地;One end of the sixteenth capacitor C16, one end of the seventeenth capacitor C17, one end of the eighteenth capacitor C18, one end of the nineteenth capacitor C19, one end of the twentieth capacitor C20, one end of the twenty-first capacitor C21 and the One end of the twenty-second capacitor C22 is connected and its connection end is connected to 3.3V voltage, the other end of the sixteenth capacitor C16, the other end of the seventeenth capacitor C17, the other end of the eighteenth capacitor C18, and the nineteenth capacitor C19 The other end of the twentieth capacitor C20, the other end of the twenty-first capacitor C21 and the other end of the twenty-second capacitor C22 are all grounded;
第三电阻R3的一端接入3.3V电压,第三电阻R3的另一端、连接端子P1的第2脚和控制芯片U2的第94脚连接,连接端子P1的第1脚接地;第四电阻R4的一端接入3.3V电压,第四电阻R4的另一端、第二十三电容C23的一端、按键S1的一端和控制芯片U2的第14脚连接,按键S1的另一端和第二十三电容C23的另一端均接地;One end of the third resistor R3 is connected to 3.3V voltage, the other end of the third resistor R3, the second pin of the connection terminal P1 is connected to the 94th pin of the control chip U2, and the first pin of the connection terminal P1 is grounded; the fourth resistor R4 One end of the fourth resistor R4 is connected to the 3.3V voltage, the other end of the fourth resistor R4, one end of the twenty-third capacitor C23, one end of the button S1 is connected to the 14th pin of the control chip U2, and the other end of the button S1 is connected to the twenty-third capacitor The other end of C23 is grounded;
控制芯片U2的第47脚和电感数字转换器U1的第16脚连接,控制芯片U2的第48脚和电感数字转换器U1的第14脚连接,控制芯片U2的第51脚和电感数字转换器U1的第2脚连接,控制芯片U2的第52脚和电感数字转换器U1的第1脚连接,控制芯片U2的第53脚和电感数字转换器U1的第5脚连接,控制芯片U2的第54脚和电感数字转换器U1的第3脚连接,控制芯片U2的第6脚、第11脚、第28脚、第50脚、第75脚和第100脚均接入3.3V电压,控制芯片U2的第10脚、第27脚、第49脚、第74脚和第99脚均接地。The 47th pin of the control chip U2 is connected to the 16th pin of the inductance-to-digital converter U1, the 48th pin of the control chip U2 is connected to the 14th pin of the inductance-to-digital converter U1, and the 51st pin of the control chip U2 is connected to the inductance-to-digital converter The 2nd pin of U1 is connected, the 52nd pin of the control chip U2 is connected with the 1st pin of the inductance-to-digital converter U1, the 53rd pin of the control chip U2 is connected with the 5th pin of the inductance-to-digital converter U1, and the 5th pin of the control chip U2 Pin 54 is connected to pin 3 of inductance-to-digital converter U1, pin 6, pin 11, pin 28, pin 50, pin 75 and pin 100 of the control chip U2 are all connected to 3.3V voltage, and the control chip The 10th, 27th, 49th, 74th and 99th pins of U2 are all grounded.
本发明中,当移动机器人需要沿着边界行走时,我们可以上述界定方法类似的引导方式来完成,即遇到边界后,调整移动机器人使得移动机器人的移动方向垂直于该边界,然后再控制移动机器人转动90度使其平行于该边界,然后就能沿着该边界移动了,如图5所示。In the present invention, when the mobile robot needs to walk along the boundary, we can complete it in a guiding manner similar to the above definition method, that is, after encountering the boundary, adjust the mobile robot so that the moving direction of the mobile robot is perpendicular to the boundary, and then control the movement The robot is turned 90 degrees so that it is parallel to the boundary, and then it can move along the boundary, as shown in Figure 5.
Claims (4)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410570402.5A CN104503448B (en) | 2014-10-23 | 2014-10-23 | Device used to define working area of mobile robot and defining method thereof |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410570402.5A CN104503448B (en) | 2014-10-23 | 2014-10-23 | Device used to define working area of mobile robot and defining method thereof |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN104503448A CN104503448A (en) | 2015-04-08 |
| CN104503448B true CN104503448B (en) | 2017-02-01 |
Family
ID=52944852
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201410570402.5A Expired - Fee Related CN104503448B (en) | 2014-10-23 | 2014-10-23 | Device used to define working area of mobile robot and defining method thereof |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN104503448B (en) |
Families Citing this family (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2019061441A1 (en) * | 2017-09-30 | 2019-04-04 | 深圳拓邦股份有限公司 | Electromagnetic field detection apparatus, movable device and boundary identification system |
| CN107479099A (en) * | 2017-09-30 | 2017-12-15 | 深圳拓邦股份有限公司 | A kind of electromagnetic field detection device, movable equipment and Boundary Recognition system |
| CN107743771A (en) * | 2017-10-19 | 2018-03-02 | 谢新昇 | One kind can avoidance automatic mowing robot |
| CN111381569B (en) * | 2018-12-29 | 2024-06-14 | 苏州宝时得电动工具有限公司 | Automatic working system, control method thereof, door control equipment and self-moving equipment |
Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US3757887A (en) * | 1971-07-09 | 1973-09-11 | Versadyne Inc | Vehicle guidance system |
| EP0001505A1 (en) * | 1977-10-07 | 1979-04-18 | The Raymond Corporation | An inductive sensor assembly for use on a ground vehicle |
| JPS5833718A (en) * | 1981-08-20 | 1983-02-28 | Nagoyashi | Inducing device for mobile body using information tile |
| JPS5852701A (en) * | 1981-09-25 | 1983-03-29 | Shinko Electric Co Ltd | Control system for unmanned car |
| JPS59231613A (en) * | 1983-06-15 | 1984-12-26 | Daifuku Co Ltd | Operation controller of electromagnetic induction type unmanned car |
| US4530056A (en) * | 1982-10-28 | 1985-07-16 | Modular Automation Corp. | Automated guided vehicle system |
| DE102008009208A1 (en) * | 2008-02-15 | 2009-08-20 | Gunter Arnold | Navigation system for navigating e.g. lawn treating robot in garden like area, has transponder implementing distance measurement based on ultrasonic delay measuring principle by bidirectional ultrasonic delay measuring |
| CN102169345A (en) * | 2011-01-28 | 2011-08-31 | 浙江亚特电器有限公司 | Setting system and setting method of action area of robot |
| CN102681545A (en) * | 2012-05-30 | 2012-09-19 | 宁波市德霖机械有限公司 | Method for controlling definition and guidance of working area of automatic equipment and system of method |
| CN202632105U (en) * | 2012-05-30 | 2012-12-26 | 宁波市德霖机械有限公司 | Working area definition and guidance system of automatic equipment |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US8706297B2 (en) * | 2009-06-18 | 2014-04-22 | Michael Todd Letsky | Method for establishing a desired area of confinement for an autonomous robot and autonomous robot implementing a control system for executing the same |
| WO2012094349A2 (en) * | 2011-01-05 | 2012-07-12 | Orbotix, Inc. | Self-propelled device with actively engaged drive system |
-
2014
- 2014-10-23 CN CN201410570402.5A patent/CN104503448B/en not_active Expired - Fee Related
Patent Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US3757887A (en) * | 1971-07-09 | 1973-09-11 | Versadyne Inc | Vehicle guidance system |
| EP0001505A1 (en) * | 1977-10-07 | 1979-04-18 | The Raymond Corporation | An inductive sensor assembly for use on a ground vehicle |
| JPS5833718A (en) * | 1981-08-20 | 1983-02-28 | Nagoyashi | Inducing device for mobile body using information tile |
| JPS5852701A (en) * | 1981-09-25 | 1983-03-29 | Shinko Electric Co Ltd | Control system for unmanned car |
| US4530056A (en) * | 1982-10-28 | 1985-07-16 | Modular Automation Corp. | Automated guided vehicle system |
| JPS59231613A (en) * | 1983-06-15 | 1984-12-26 | Daifuku Co Ltd | Operation controller of electromagnetic induction type unmanned car |
| DE102008009208A1 (en) * | 2008-02-15 | 2009-08-20 | Gunter Arnold | Navigation system for navigating e.g. lawn treating robot in garden like area, has transponder implementing distance measurement based on ultrasonic delay measuring principle by bidirectional ultrasonic delay measuring |
| CN102169345A (en) * | 2011-01-28 | 2011-08-31 | 浙江亚特电器有限公司 | Setting system and setting method of action area of robot |
| CN102681545A (en) * | 2012-05-30 | 2012-09-19 | 宁波市德霖机械有限公司 | Method for controlling definition and guidance of working area of automatic equipment and system of method |
| CN202632105U (en) * | 2012-05-30 | 2012-12-26 | 宁波市德霖机械有限公司 | Working area definition and guidance system of automatic equipment |
Non-Patent Citations (1)
| Title |
|---|
| 《德州仪器电感数字转换器推动位置及运动传感的给新》;胥京宇;《世界电子元器件》;20131231(第10期);第52页 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN104503448A (en) | 2015-04-08 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN104503448B (en) | Device used to define working area of mobile robot and defining method thereof | |
| CN105467982B (en) | The system and method for making automatic running device be worked in limited area | |
| CN104460663A (en) | Method for controlling cleaning robot through smart phone | |
| Jianyu et al. | Frequency splitting analysis of wireless power transfer system based on T-type transformer model | |
| CN107612159A (en) | A kind of PWM that has concurrently controls the single-shot with frequency modulation control to penetrate to four receiving coil electric automobile static state wireless power supply systems | |
| CN103944071B (en) | The ion circuit for generating that a kind of ionic weight is adjustable | |
| CN104953722A (en) | Control method for improving deviation tolerance of wireless charging system | |
| CN103344927B (en) | Magnetic resonance radio frequency coil and magnetic resonance imaging system | |
| CN105702545B (en) | Electron beam rapidform machine electron gun system with focus-compensating function | |
| Che et al. | Study on wireless communication system of robot for inspecting and cleaning subway ventilation and smoke exhaust metal ducting | |
| CN104485196B (en) | A kind of low-temperature-rise high thrust DC electromagnet | |
| CN107729683B (en) | Electric field analysis method of magnetic resonance wireless power supply in high-voltage power line monitoring | |
| CN210839081U (en) | Nonlinear Wireless Power Transfer System with Variable Coupling Coefficient Stability | |
| CN204925412U (en) | Superconductive transition electromagnetic emission of low temperature machine based on RC and many C cascade | |
| CN204347170U (en) | Distribution network line fault monitoring device and real-time monitoring system | |
| CN106249075A (en) | A kind of control system of multifunctional electric meter | |
| CN204122919U (en) | A kind of high frequency micro beam plasma welding power supply | |
| CN212256052U (en) | Control circuit of sweeper | |
| CN112986380B (en) | Combined pulse source electromagnetic detection method and device for grounding grid topological structure | |
| CN207588478U (en) | A kind of power transmission line crusing robot charging system based on unmanned plane | |
| CN104052310B (en) | A kind of tandem ultra-low frequency high-pressure generator | |
| CN102937722B (en) | Metal approach sensor | |
| CN104653473B (en) | Solar power telemetry remote control three-phase motor automatic irrigation water pump | |
| CN114915045A (en) | Fixed parameter frequency splitting external optimization method and circuit | |
| CN107453491A (en) | Wireless power reception device |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170201 Termination date: 20191023 |
|
| CF01 | Termination of patent right due to non-payment of annual fee |