主权项 |
一种室内机器人的定位和导航系统,包括可自由移动的机器人和固定的定位导航器,其特征在于,所述机器人包括:光标记发射器,用于向固定的表面形成光标记,所述光标记在所述固定的表面的位置与机器人在其运动区域内所处的位置一一对应;所述机器人的运动区域为室内的地面,所述固定的表面为与地面相对的天花板;所述光标记发射器将光标记自地面向天花板垂直投射;所述光标记发射器对称安装于机器人左右两侧;无线模块,用于接收导航信号;运动控制模块,用于根据接收到的导航信号生成相应的驱动控制信号;运动机构,用于根据所述驱动控制信号运行以带动机器人移动;所述定位导航器包括:光标记检测器,用于检测所述光标记,并确定所述光标记的坐标;所述光标记检测器确定两个光标记的位置(X<sub>1</sub>,Y<sub>1</sub>),(X<sub>2</sub>,Y<sub>2</sub>);定位导航模块,用于根据所述光标记的坐标定位机器人在其运动区域内的位置,并且根据目标位置和机器人的位置规划和修正移动路径,生成导航信号;其中,所述机器人的位置为:<maths num="0001"><math><![CDATA[<mrow><mo>(</mo><mi>X</mi><mo>,</mo><mi>Y</mi><mo>)</mo><mo>=</mo><mo>(</mo><mfrac><mrow><msub><mi>X</mi><mn>1</mn></msub><mo>+</mo><msub><mi>X</mi><mn>2</mn></msub></mrow><mn>2</mn></mfrac><mo>,</mo><mfrac><mrow><msub><mi>Y</mi><mn>1</mn></msub><mo>+</mo><msub><mi>Y</mi><mn>2</mn></msub></mrow><mn>2</mn></mfrac><mo>)</mo></mrow>]]></math><img file="FDA0001019276390000011.GIF" wi="558" he="133" /></maths>所述定位导航模块根据相邻两帧获得的机器人的位置(X,Y)(X′,Y′)获得机器人运动的方向角:<maths num="0002"><math><![CDATA[<mrow><mi>α</mi><mo>=</mo><msup><mi>tan</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><mfrac><mrow><mi>Y</mi><mo>-</mo><msup><mi>Y</mi><mo>′</mo></msup></mrow><mrow><mi>X</mi><mo>-</mo><msup><mi>X</mi><mo>′</mo></msup></mrow></mfrac><mo>;</mo></mrow>]]></math><img file="FDA0001019276390000012.GIF" wi="374" he="119" /></maths>所述机器人的运动方向为:<img file="FDA0001019276390000013.GIF" wi="381" he="149" />或者<img file="FDA0001019276390000014.GIF" wi="525" he="149" />机器人当前时刻实际的运动方向角θ取与α夹角小于90°的那个方向;所述定位导航模块根据当前运动方向θ与到目标位置的方向β的夹角e进行躲避障碍物的导航,其中:<maths num="0003"><math><![CDATA[<mrow><mi>e</mi><mo>=</mo><mi>θ</mi><mo>-</mo><mi>β</mi><mo>=</mo><mi>θ</mi><mo>-</mo><msup><mi>tan</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><mfrac><mrow><msub><mi>Y</mi><mn>0</mn></msub><mo>-</mo><mi>Y</mi></mrow><mrow><msub><mi>X</mi><mn>0</mn></msub><mo>-</mo><mi>X</mi></mrow></mfrac><mo>;</mo></mrow>]]></math><img file="FDA0001019276390000021.GIF" wi="614" he="126" /></maths>无线模块,用于发送所述导航信号。 |