CN104216410A - 用于大型室内公共场所的盲人导航助行小车及其定位方法 - Google Patents
用于大型室内公共场所的盲人导航助行小车及其定位方法 Download PDFInfo
- Publication number
- CN104216410A CN104216410A CN201410493884.9A CN201410493884A CN104216410A CN 104216410 A CN104216410 A CN 104216410A CN 201410493884 A CN201410493884 A CN 201410493884A CN 104216410 A CN104216410 A CN 104216410A
- Authority
- CN
- China
- Prior art keywords
- control module
- ultrasound wave
- module
- navigation
- car body
- 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
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
用于大型室内公共场所的盲人导航助行小车及其定位方法，属于盲人助行导航技术领域。为了解决目前用于导盲的服务机器人在保证定位精度的同时，过密的铺设超声波信标使成本增加的问题。助行小车通过布置在所述室内的棚顶的超声波接收阵列，实现小范围高精度定位，通过安装在小车后轮的编码器与电子罗盘的航迹推算组合实现大范围低精度的惯性导航，利用扩展卡尔曼滤波进行数据融合；如果助行小车行进过程中遇到障碍物，则通过避障系统进行提示使用者障碍物的方位，还可以通过语音和主控系统进行交互，询问当前位置及指定目的地，主控系统控制通过语音播报、提示导航路线。它用于盲人导航。
Description
技术领域
本发明涉及属于盲人助行导航技术领域。
背景技术
老龄化已经成为全球性问题，另据世界卫生组织最新估计,全球约有4500万盲人。随着社会的发展和科技的进步，已经有许多公共设施及专用设备得到了应用，但是出行困难依然是老年人群体和盲人群体最困扰的问题。为了方便老年人和盲人出行，具有辅助行走、康复训练、导盲等功能的助行系统已逐渐成为国内外机器人与康复医学领域的研究热点。
服务机器人是一种可以帮助人类完成服务性工作的半自主或全自主工作的机器人。根据数据资料显示，全球范围内的服务机器人有着广泛的市场。近年来，服务机器人市场发展保持了较快的增长速度。随着劳动力价格日趋上涨，从事保安、看护、清洁工作的简单劳动力越来越少，但全球人口老龄化的加剧，看护等工作的人员需求却越来越多。为了弥补这种供需的巨大差异，服务机器人市场由此产生。
目前用于导盲的服务机器人在定位时多采用超声波网络定位，超声波网络定位系统需要一个光速级的同步信号来进行测距时间上的同步，通过收到的超声波信标的数据解算出机器人当前的位置。超声波网络定位系统能在信标覆盖区域重合的位置提供高精度的定位，但是由于超声波信标铺设的密度会直接影响定位的精度，过密的铺设又无疑会增加成本。
发明内容
本发明的目的是为了解决目前用于导盲的服务机器人在保证定位精度的同时，过密的铺设超声波信标使成本增加的问题，本发明提供一种用于大型室内公共场所的盲人导航助行小车及其定位方法。
本发明的用于大型室内公共场所的盲人导航助行小车，
盲人导航助行小车包括车体、超声波避障模块、避障控制模块、微震马达、超声波发射头、第一超声波控制模块、第二超声波控制模块、射频模块、超声波接收阵列、主控模块、语音系统、2个编码器、编码器连接板和电子罗盘；
超声波避障模块、避障控制模块、超声波发射头、第一超声波控制模块、主控模块和提示系统均设置在车体上，其中，超声波避障模块安装在车体的前端，超声波发射头设置在车体的顶端，并指向室内的棚顶；微震马达安装在车体扶手处；
第二超声波控制模块、射频模块和超声波接收阵列均设置在所述室内的棚顶；
超声波避障模块检测的避障信号输入至避障控制模块，避障控制模块根据避障信号控制微震马达震动；
主控模块的避障控制信号输入至避障控制模块，
超声波接收阵列接收定位的地址数据输入至第二超声波控制模块，第二超声波控制模块通过射频模块将地址数据发送至第一超声波控制模块，第一超声波控制模块将接收的地址数据输入至主控模块，主控模块将发射控制信号输入至第一超声波控制模块，第一超声波控制模块将发射控制信号输入至超声波发射头；
语音系统将目的地信号输入至主控模块，主控模块根据当前时刻的地址数据确定当前车体的位置，再结合目的地信号规划导航路径，输出目的地导航信号输入至语音系统，语音系统根据目的地导航信号进行语音提示；
所述车体上还设置3个轮，
3个轮包括1个前轮和2个后轮，前轮设置在车体前端的底部，2个后轮设置在车体后端的底部；2个编码器分别安装在2个后轮上，2个编码器的脉冲数据均通过编码器连接板输入至主控模块；
电子罗盘将当前检测到的绝对角度值输入至主控模块，
当主控模块接收不到当前时刻的地址数据时，主控模块根据输入的当前时刻脉冲数据、绝对角度值和上一时刻的地址数据确定当前车体的位置，再结合目的地信号规划导航路径，输出目的地导航信号输入至语音系统。
盲人导航助行小车包括3个超声波避障模块，1号超声波避障模块设置在车体的前端的左侧，2号超声波避障模块设置在车体的前端的正前侧，3号超声波避障模块设置在车体的前端的右侧，3个超声波避障模块检测到的避障信号均发送给避障控制模块。
盲人导航助行小车包括2个微震马达，当1号超声波避障模块检测到障碍物，避障控制模块控制1号微震马达震动，当3号超声波避障模块检测到障碍物，避障控制模块控制2号微震马达震动，当2号超声波避障模块检测到障碍物，避障控制模块控制1号微震马达和2号微震马达同时震动；
2个微震马达分别安装在车体的左右扶手上。
盲人导航助行小车还包括蜂鸣器，当超声波避障模块检测到障碍物时，避障控制模块控制蜂鸣器蜂鸣。
所述语音系统包括语音模块、麦克风和扬声器；
麦克风接收语音命令，并将所述语音命令输入至语音模块，语音模块将将语音命令转换成目的地信号，
语音模块将目的地导航信号转换成目的地语音提示信号输入至扬声器，扬声器根据目的地语音提示信号进行语音提示。
所述盲人导航助行小车还包括播报按钮；
该播报按钮用于控制语音模块接收或停止接收麦克风采集的语音指令。。
所述超声波接收阵列包括四个超声波接收模块；所述四个超声波接收模块在棚顶呈正方形设置，所述正方形的边长
H为超声波发射头与四个超声波接收模块形成的平面的距离；
为超声波发射头的发射角。
所述盲人导航助行小车还包括显示装置，主控模块控制所述显示装置显示车体的当前位置
所述的用于大型室内公共场所的盲人导航助行小车的定位方法，所述定位方法是通过在主控模块内嵌入软件实现，所述软件包括如下步骤：
接收当前时刻超声波接收阵列定位的地址数据的步骤；
接收当前时刻电子罗盘输入的绝对角度值的步骤；
接收当前时刻两个编码器的脉冲数据的步骤；
根据接收的脉冲数据，分别获得2个后轮的当前移动距离；
当没收到当前时刻的地址数据时，则将绝对角度值通过扩展卡尔曼滤波的状态更新方程与获得的当前移动距离进行融合，获得车体的位置数据的步骤；
当收到当前时刻的地址数据时，则将当前时刻的地址数据和电子罗盘数据通过扩展卡尔曼滤波的状态更新方程与获得的当前移动距离进行融合，获得车体的位置数据的步骤。
本发明的有益效果在于，本发明的用于大型室内公共场所的盲人导航助行小车集定位、导航、语音交互、实时避障为一体，在大型公共场所为盲人提供助行服务。盲人可以通过语音和助行小车系统进行交互，询问当前位置及指定目的地，助行小车系统也可以通过语音播报、提示导航路线；助行小车通过超声波网络定位系统(布置在关键位置的超声波接收阵列)实现小范围高精度定位，通过编码器与电子罗盘的航迹推算组合实现大范围低精度的惯性导航，利用扩展卡尔曼滤波进行数据融合；如果助行小车行进过程中遇到障碍物，则会激活在小车周围布置的超声波避障系统，通过声音提示和安装在助行小车两个把手内的微震马达提醒使用者障碍物的方位。
本发明的助行小车结合了航迹推算成本低，方法简单的优点和超声波定位高精度的优点，同时又避免了航迹推算误差积累和超声波网络定位系统信标铺设密度大的缺点，极大地提高了定位精度，降低了成本。
附图说明
图1为本发明的用于大型室内公共场所的盲人导航助行小车的电气原理示意图。
图2为本发明所述的用于大型室内公共场所的盲人导航助行小车的结构示意图。
图3为图2的A向视图。
图4为图3的B向视图。
具体实施方式
具体实施方式一：结合图1、图2、图3和图4说明本实施方式，本实施方式所述的用于大型室内公共场所的盲人导航助行小车，盲人导航助行小车包括车体7、超声波避障模块、避障控制模块、微震马达3、超声波发射头6、第一超声波控制模块、第二超声波控制模块、射频模块、超声波接收阵列、主控模块、语音系统、2个编码器、编码器连接板和电子罗盘；
超声波避障模块、避障控制模块、超声波发射头6、第一超声波控制模块、主控模块和提示系统均设置在车体7上，其中，超声波避障模块安装在车体7的前端，超声波发射头6设置在车体7的顶端，并指向室内的棚顶；微震马达3安装在车体7扶手处；
第二超声波控制模块、射频模块和超声波接收阵列均设置在所述室内的棚顶；
超声波避障模块检测的避障信号输入至避障控制模块，避障控制模块根据避障信号控制微震马达3震动；
主控模块的避障控制信号输入至避障控制模块，
超声波接收阵列接收定位的地址数据输入至第二超声波控制模块，第二超声波控制模块通过射频模块将地址数据发送至第一超声波控制模块，第一超声波控制模块将接收的地址数据输入至主控模块，主控模块将发射控制信号输入至第一超声波控制模块，第一超声波控制模块将发射控制信号输入至超声波发射头6；
语音系统将目的地信号输入至主控模块，主控模块根据当前时刻的地址数据确定当前车体7的位置，再结合目的地信号规划导航路径，输出目的地导航信号输入至语音系统，语音系统根据目的地导航信号进行语音提示；
所述车体7上还设置3个轮，
3个轮包括1个前轮9和2个后轮8，前轮9设置在车体7前端的底部，2个后轮8设置在车体7后端的底部；2个编码器分别安装在2个后轮8上，2个编码器的脉冲数据均通过编码器连接板输入至主控模块；
电子罗盘将当前检测到的绝对角度值输入至主控模块，
当主控模块接收不到当前时刻的地址数据时，主控模块根据输入的当前时刻脉冲数据、绝对角度值和上一时刻的地址数据确定当前车体7的位置，再结合目的地信号规划导航路径，输出目的地导航信号输入至语音系统。本实施方式中，
根据超声波网络定位系统的工作原理，第二超声波控制模块的工作流程如下：
(1)启动超声波接收阵列，模块初始化后，进入等待状态并等待接收定位信号。
(2)主控模块控制第一超声波控制模块向超声波发射头发送定位指令，超声波发射头接收到定位指令后首先通过射频模块向超声波接收阵列发送同步信号并等待信号返回。
(3)超声波接收阵列收到同步信号后返回确认信号并开始计时，超声波接收阵列开始接收超声波。
(4)超声波发射头接收到确认信号之后开始发射40kHz超声波，并且开始进入等待状态，等待预设的时间。
(5)超声波接收阵列每一个接收模块接收到超声波之后便屏蔽相应的接收模块并记录时间，当超声波接收阵列全部接收到超声波信号或者超过最大接收时间时，停止计时，没有收到超声波的超声波接收模块相应的接收时间记录为溢出标志。
(6)当预设的时间到达之后，第二超声波控制模块发送返回数据指令到超声波接收阵列，并等待数据返回。
(7)超声波接收阵列接收到返回数据指令之后，将超声波接收阵列的计时时间打包成数据帧返回，之后进入等待状态。
(8)超声波发射头接收到数据帧之后将数据返回给主控模块，并进入等待状态，等待下次测量命令。
本实施方式中，在小车的2个后轮上分别安装两个编码器，同时在小车上安装一个电子罗盘，通过记录小车两后轮的脉冲数，便可以通过编码器航迹推算计算出相对于上一时刻助行机器人的行走距离及旋转角度。同时根据电子罗盘当前输出的绝对角度值、超声波定位的坐标，通过扩展卡尔曼滤波进行数据融合，得出当前位置的最优估计值。
本实施方式中，主控模块主要完成以下工作：
(1)定期向第一超声波发射控制模块发送定位指令，并循环检测超声波接收阵列返回的数据帧，如果收到便执行相应的坐标计算程序；
(2)定期向电子罗盘发送测量指令，并循环检测电子罗盘返回的数据帧，如果收到便将当前绝对角度值更新；
(3)循环检测编码器的脉冲数，如果收到脉冲，根据旋转方向确定脉冲值正负并记录，计算出移动距离；
(4)检测语音系统发送的数据帧，如果收到则根据相应的数据帧执行相应的处理函数；
(5)定期得出当前位置的最优估计值；
主控模块的程序可以写在一个主循环之中，每次循环对各个端口进行检测，如果满足要求便执行相应的操作，这是最原始的编写裸机程序，面向过程的思路，如果其中某个端口出现错误卡住，会导致整个程序卡死出错，这是非常不好的编程方法。
由于这几项工作各自可以独立执行，只是存在变量之前的调用。又因为Linux和Qt对多线程有着非常好的支持，因此主控程序采用多线程的思路编写，界面显示为主线程，分别为超声波网络定位系统，电子罗盘、编码器、语音模块建立四个次线程，各自的检测程序在各自的线程中独立运行，这样能将每个模块之间的影响降到最低。
具体实施方式二：本实施方式是对具体实施方式一所述的用于大型室内公共场所的盲人导航助行小车的进一步限定，盲人导航助行小车包括3个超声波避障模块，1号超声波避障模块12设置在车体7的前端的左侧，2号超声波避障模块11设置在车体7的前端的正前侧，3号超声波避障模块10设置在车体7的前端的右侧，3个超声波避障模块检测到的避障信号均发送给避障控制模块。
具体实施方式三：本实施方式是对具体实施方式二所述的用于大型室内公共场所的盲人导航助行小车的进一步限定，盲人导航助行小车包括2个微震马达3，当1号超声波避障模块12检测到障碍物，避障控制模块控制1号微震马达3震动，当3号超声波避障模块10检测到障碍物，避障控制模块控制2号微震马达3震动，当2号超声波避障模块11检测到障碍物，避障控制模块控制1号微震马达3和2号微震马达3同时震动；
2个微震马达3分别安装在车体7的左右扶手上。
超声波避障模块需要实时监测周围出现的障碍物，当障碍物接近到预定距离时，相应的把手产生震动。
具体实施方式四：本实施方式是对具体实施方式三所述的用于大型室内公共场所的盲人导航助行小车的进一步限定，盲人导航助行小车还包括蜂鸣器，当超声波避障模块检测到障碍物时，避障控制模块控制蜂鸣器蜂鸣。
具体实施方式五：本实施方式是对具体实施方式一所述的用于大型室内公共场所的盲人导航助行小车的进一步限定，所述语音系统包括语音模块、麦克风2和扬声器5；
麦克风2接收语音命令，并将所述语音命令输入至语音模块，语音模块将将语音命令转换成目的地信号，
语音模块将目的地导航信号转换成目的地语音提示信号输入至扬声器5，扬声器5根据目的地语音提示信号进行语音提示。
具体实施方式六：本实施方式是对具体实施方式五所述的用于大型室内公共场所的盲人导航助行小车的进一步限定，所述盲人导航助行小车还包括播报按钮4；
该播报按钮4用于控制语音模块接收或停止接收麦克风2采集的语音指令。
具体实施方式七：本实施方式是对具体实施方式一所述的用于大型室内公共场所的盲人导航助行小车的进一步限定，
所述超声波接收阵列包括四个超声波接收模块；所述四个超声波接收模块在棚顶呈正方形设置，所述正方形的边长
H为超声波发射头6与四个超声波接收模块形成的平面的距离；
为超声波发射头6的发射角。
本实施方式中，对超声波接收阵列的布置：
在一定的距离内，超声波发射信号的覆盖范围可以看做是圆锥面，发射模块发射的超声波信号覆盖到天花板上可近似成一个半径为R的圆，圆的半径与发射角的关系见下式：
其中为所用超声波传感器的发射角，H为超声波发射端到超声波接收端的垂直距离。根据超声波网络定位系统的工作原理，布置的原则便是：在尽可能收到多的超声波的情况下，布置的越分散，精度越高。为了让超声波网络定位系统能够存在同时收到超声波接收阵列中4路超声波数据的位置，因此超声波接收阵列里面4路超声波都必须安装在以R为半径的圆内。如果一个超声波阵列中的4路超声波安装正方形布置，则为了能够存在同时收到4路超声波数据的位置，只能布置在以R为半径的圆的内接正方形的顶点处。此时，相邻2路超声波接收模块最大间距为：
有了上述公式，就能够确定超声波接收阵列中4路超声波应该如何布置了。通过超声波发射头的技术资料得知发射角为50度。因此只要确定了超声波发射模块与接收模块间的垂直距离便可以根据上式计算出超声波接收阵列大致的布置位置。例如走廊棚顶到地面的距离大约3米，超声波发射模块距离地面大约1.3米，因此根据上式可以算出
因此超声波接收阵列大致按照1m*1m的正方形布置。
具体实施方式八：本实施方式是对具体实施方式一所述的用于大型室内公共场所的盲人导航助行小车的进一步限定，所述盲人导航助行小车还包括显示装置1，主控模块控制所述显示装置1显示车体7的当前位置。
具体实施方式九：本实施方式是具体实施方式一所述的用于大型室内公共场所的盲人导航助行小车的定位方法，所述定位方法是通过在主控模块内嵌入软件实现，所述软件包括如下步骤：
接收当前时刻超声波接收阵列定位的地址数据的步骤；
接收当前时刻电子罗盘输入的绝对角度值的步骤；
接收当前时刻两个编码器的脉冲数据的步骤；
根据接收的脉冲数据，分别获得2个后轮8的当前移动距离；
当没收到当前时刻的地址数据时，则将绝对角度值通过扩展卡尔曼滤波的状态更新方程与获得的当前移动距离进行融合，获得车体7的位置数据的步骤；
当收到当前时刻的地址数据时，则将当前时刻的地址数据和电子罗盘数据通过扩展卡尔曼滤波的状态更新方程与获得的当前移动距离进行融合，获得车体7的位置数据的步骤。
扩展卡尔曼滤波(Extended Kalman Filter，简称EKF)，应用非线性领域之中。EKF的基本思想就是将非线性系统线性化之后，便可以通过卡尔曼滤波进行滤波。因此扩展卡尔曼滤波在计算之中需要不断地修改系统状态方程和观测方程来实现高精度，高效率的递归滤波。
对本发明的用于大型室内公共场所的盲人导航助行小车进行实验：
在超声波定位实验之前，首先要对单个超声波的测距精度进行测试，我们将小车固定到超声波接收模块附近位置不动，采集收到的超声波接收模块距离数据进行分析。
实验结果显示，在室内比较拥挤的环境之中，当超声波接收模块的最大增益设置为11时，超声波接收模块会很敏感。对采集的71组测距数据分析发现，实际距离应为1505mm，采集的71组数据平均值为1556mm，误差为51mm，最大偏差为354mm，标准差为105.33mm。这已经超出了最大误差的范围，会造成超声波定位误差很大，无法高精度定位。
之后，将超声波接收模块的最大增益设置为6，对采集的210组测距数据分析发现，实际距离为1505mm，采集数据的平均值为1504.2mm，误差为0.8mm，最大偏差为6mm，标准差为1.283mm。数据稳定，误差小，满足高精度定位要求。这说明在拥挤的环境中需要设置超声波接收端为低敏感度以减小误差。
在设置完增益后，进行了超声波定位实验。将助行机器人小车放置在坐标为(1100,0)的位置，沿着y轴走一条直线，通过超声波定位采集的定位数据。定位数据几乎和真实数据相差无几，行走路线和真实路线几乎重合，说明超声波网络定位系统能够实现高精度定位，满足设计要求。本发明排除了接收增益的干扰，实现了高精度定位。
Claims (9)
1.用于大型室内公共场所的盲人导航助行小车，其特征在于，盲人导航助行小车包括车体(7)、超声波避障模块、避障控制模块、微震马达(3)、超声波发射头(6)、第一超声波控制模块、第二超声波控制模块、射频模块、超声波接收阵列、主控模块、语音系统、2个编码器、编码器连接板和电子罗盘；
超声波避障模块、避障控制模块、超声波发射头(6)、第一超声波控制模块、主控模块和提示系统均设置在车体(7)上，其中，超声波避障模块安装在车体(7)的前端，超声波发射头(6)设置在车体(7)的顶端，并指向室内的棚顶；微震马达(3)安装在车体(7)扶手处；
第二超声波控制模块、射频模块和超声波接收阵列均设置在所述室内的棚顶；
超声波避障模块检测的避障信号输入至避障控制模块，避障控制模块根据避障信号控制微震马达(3)震动；
主控模块的避障控制信号输入至避障控制模块，
超声波接收阵列接收定位的地址数据输入至第二超声波控制模块，第二超声波控制模块通过射频模块将地址数据发送至第一超声波控制模块，第一超声波控制模块将接收的地址数据输入至主控模块，主控模块将发射控制信号输入至第一超声波控制模块，第一超声波控制模块将发射控制信号输入至超声波发射头(6)；
语音系统将目的地信号输入至主控模块，主控模块根据当前时刻的地址数据确定当前车体(7)的位置，再结合目的地信号规划导航路径，输出目的地导航信号输入至语音系统，语音系统根据目的地导航信号进行语音提示；
所述车体(7)上还设置3个轮，
3个轮包括1个前轮(9)和2个后轮(8)，前轮(9)设置在车体(7)前端的底部，2个后轮(8)设置在车体(7)后端的底部；2个编码器分别安装在2个后轮(8)上，2个编码器的脉冲数据均通过编码器连接板输入至主控模块；
电子罗盘将当前检测到的绝对角度值输入至主控模块，
当主控模块接收不到当前时刻的地址数据时，主控模块根据输入的当前时刻脉冲数据、绝对角度值和上一时刻的地址数据确定当前车体(7)的位置，再结合目的地信号规划导航路径，输出目的地导航信号输入至语音系统。
2.根据权利要求1所述的用于大型室内公共场所的盲人导航助行小车，其特征在于，盲人导航助行小车包括3个超声波避障模块，1号超声波避障模块(12)设置在车体(7)的前端的左侧，2号超声波避障模块(11)设置在车体(7)的前端的正前侧，3号超声波避障模块(10)设置在车体(7)的前端的右侧，3个超声波避障模块检测到的避障信号均发送给避障控制模块。
3.根据权利要求2所述的用于大型室内公共场所的盲人导航助行小车，其特征在于，盲人导航助行小车包括2个微震马达(3)，当1号超声波避障模块(12)检测到障碍物，避障控制模块控制1号微震马达(3)震动，当3号超声波避障模块(10)检测到障碍物，避障控制模块控制2号微震马达(3)震动，当2号超声波避障模块(11)检测到障碍物，避障控制模块控制1号微震马达(3)和2号微震马达(3)同时震动；
2个微震马达(3)分别安装在车体(7)的左右扶手上。
4.根据权利要求3所述的用于大型室内公共场所的盲人导航助行小车，其特征在于，盲人导航助行小车还包括蜂鸣器，当超声波避障模块检测到障碍物时，避障控制模块控制蜂鸣器蜂鸣。
5.根据权利要求1所述的用于大型室内公共场所的盲人导航助行小车，其特征在于，所述语音系统包括语音模块、麦克风(2)和扬声器(5)；
麦克风(2)接收语音命令，并将所述语音命令输入至语音模块，语音模块将将语音命令转换成目的地信号，
语音模块将目的地导航信号转换成目的地语音提示信号输入至扬声器(5)，扬声器(5)根据目的地语音提示信号进行语音提示。
6.根据权利要求5所述的用于大型室内公共场所的盲人导航助行小车，其特征在于，所述盲人导航助行小车还包括播报按钮(4)；该播报按钮(4)用于控制语音模块接收或停止接收麦克风(2)采集的语音指令。
7.根据权利要求1所述的用于大型室内公共场所的盲人导航助行小车，其特征在于，所述超声波接收阵列包括四个超声波接收模块；所述四个超声波接收模块在棚顶呈正方形设置，所述正方形的边长
H为超声波发射头(6)与四个超声波接收模块形成的平面的距离；
为超声波发射头(6)的发射角。
8.根据权利要求1所述的用于大型室内公共场所的盲人导航助行小车，其特征在于，所述盲人导航助行小车还包括显示装置1，主控模块控制所述显示装置1显示车体(7)的当前位置。
9.权利要求1所述的用于大型室内公共场所的盲人导航助行小车的定位方法，其特征在于，所述定位方法是通过在主控模块内嵌入软件实现，所述软件包括如下步骤：
接收当前时刻超声波接收阵列定位的地址数据的步骤；
接收当前时刻电子罗盘输入的绝对角度值的步骤；
接收当前时刻两个编码器的脉冲数据的步骤；
根据接收的脉冲数据，分别获得2个后轮(8)的当前移动距离；
当没收到当前时刻的地址数据时，则将绝对角度值通过扩展卡尔曼滤波的状态更新方程与获得的当前移动距离进行融合，获得车体(7)的位置数据的步骤；
当收到当前时刻的地址数据时，则将当前时刻的地址数据和电子罗盘数据通过扩展卡尔曼滤波的状态更新方程与获得的当前移动距离进行融合，获得车体(7)的位置数据的步骤。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410493884.9A CN104216410B (zh) | 2014-09-24 | 2014-09-24 | 用于大型室内公共场所的盲人导航助行小车及其定位方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410493884.9A CN104216410B (zh) | 2014-09-24 | 2014-09-24 | 用于大型室内公共场所的盲人导航助行小车及其定位方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN104216410A true CN104216410A (zh) | 2014-12-17 |
| CN104216410B CN104216410B (zh) | 2017-01-11 |
Family
ID=52098015
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201410493884.9A Active CN104216410B (zh) | 2014-09-24 | 2014-09-24 | 用于大型室内公共场所的盲人导航助行小车及其定位方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN104216410B (zh) |
Cited By (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104655127A (zh) * | 2015-01-16 | 2015-05-27 | 深圳市前海安测信息技术有限公司 | 基于电子标签的室内导盲系统和导盲方法 |
| CN105662796A (zh) * | 2016-03-15 | 2016-06-15 | 江苏龙昌智能科技有限公司 | 一种盲人智能助行服及其导航方法 |
| CN106606407A (zh) * | 2015-10-22 | 2017-05-03 | 北京金坤科创技术有限公司 | 一种室内高精度盲人导航系统 |
| CN106918339A (zh) * | 2017-04-18 | 2017-07-04 | 胡绪健 | 一种盲人室内导航系统 |
| CN107174418A (zh) * | 2017-06-28 | 2017-09-19 | 歌尔股份有限公司 | 一种智能轮椅及其控制方法 |
| CN107423667A (zh) * | 2017-04-12 | 2017-12-01 | 杭州奥腾电子股份有限公司 | 一种车体上的预测障碍物的方法 |
| CN108267137A (zh) * | 2017-01-04 | 2018-07-10 | 北京京东尚科信息技术有限公司 | 定位方法、装置、业务处理系统以及计算机可读存储介质 |
| CN111562781A (zh) * | 2020-04-01 | 2020-08-21 | 电子科技大学 | 一种基于惯性导航的室内导盲小车 |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20060136097A1 (en) * | 2004-12-17 | 2006-06-22 | Yong-Jae Kim | Robot system |
| CN102156476A (zh) * | 2011-04-14 | 2011-08-17 | 山东大学 | 智能空间与护士机器人多传感器系统及其信息融合方法 |
| CN102385056A (zh) * | 2011-08-11 | 2012-03-21 | 西北工业大学 | 一种基于多超声波传感器的导盲避碰装置及其控制算法 |
| CN202497412U (zh) * | 2012-01-18 | 2012-10-24 | 李忠孝 | 导盲推车 |
| CN103092201A (zh) * | 2012-08-10 | 2013-05-08 | 江苏科技大学 | 基于射频识别的多传感器语音导盲机器人及路径规划方法 |
| CN103592944A (zh) * | 2013-10-24 | 2014-02-19 | 燕山大学 | 一种超市购物机器人及其行进路径规划方法 |
-
2014
- 2014-09-24 CN CN201410493884.9A patent/CN104216410B/zh active Active
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20060136097A1 (en) * | 2004-12-17 | 2006-06-22 | Yong-Jae Kim | Robot system |
| CN102156476A (zh) * | 2011-04-14 | 2011-08-17 | 山东大学 | 智能空间与护士机器人多传感器系统及其信息融合方法 |
| CN102385056A (zh) * | 2011-08-11 | 2012-03-21 | 西北工业大学 | 一种基于多超声波传感器的导盲避碰装置及其控制算法 |
| CN202497412U (zh) * | 2012-01-18 | 2012-10-24 | 李忠孝 | 导盲推车 |
| CN103092201A (zh) * | 2012-08-10 | 2013-05-08 | 江苏科技大学 | 基于射频识别的多传感器语音导盲机器人及路径规划方法 |
| CN103592944A (zh) * | 2013-10-24 | 2014-02-19 | 燕山大学 | 一种超市购物机器人及其行进路径规划方法 |
Non-Patent Citations (1)
| Title |
|---|
| 常超等: "一种基于TDOA算法的轨道机器人室内定位系统", 《安阳工学院学报》 * |
Cited By (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104655127A (zh) * | 2015-01-16 | 2015-05-27 | 深圳市前海安测信息技术有限公司 | 基于电子标签的室内导盲系统和导盲方法 |
| CN104655127B (zh) * | 2015-01-16 | 2017-08-22 | 深圳市前海安测信息技术有限公司 | 基于电子标签的室内导盲系统和导盲方法 |
| CN106606407A (zh) * | 2015-10-22 | 2017-05-03 | 北京金坤科创技术有限公司 | 一种室内高精度盲人导航系统 |
| CN105662796A (zh) * | 2016-03-15 | 2016-06-15 | 江苏龙昌智能科技有限公司 | 一种盲人智能助行服及其导航方法 |
| CN108267137A (zh) * | 2017-01-04 | 2018-07-10 | 北京京东尚科信息技术有限公司 | 定位方法、装置、业务处理系统以及计算机可读存储介质 |
| WO2018126911A1 (zh) * | 2017-01-04 | 2018-07-12 | 北京京东尚科信息技术有限公司 | 定位方法、装置、业务处理系统以及计算机可读存储介质 |
| CN108267137B (zh) * | 2017-01-04 | 2020-03-27 | 北京京东尚科信息技术有限公司 | 定位方法、装置、业务处理系统以及计算机可读存储介质 |
| CN107423667A (zh) * | 2017-04-12 | 2017-12-01 | 杭州奥腾电子股份有限公司 | 一种车体上的预测障碍物的方法 |
| CN106918339A (zh) * | 2017-04-18 | 2017-07-04 | 胡绪健 | 一种盲人室内导航系统 |
| CN107174418A (zh) * | 2017-06-28 | 2017-09-19 | 歌尔股份有限公司 | 一种智能轮椅及其控制方法 |
| CN111562781A (zh) * | 2020-04-01 | 2020-08-21 | 电子科技大学 | 一种基于惯性导航的室内导盲小车 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN104216410B (zh) | 2017-01-11 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN104216410A (zh) | 用于大型室内公共场所的盲人导航助行小车及其定位方法 | |
| CN106444803B (zh) | 一种用于管道机器人定位的无人机导航系统及方法 | |
| EP3635500B1 (en) | Method of navigating a vehicle and system thereof | |
| US9851718B2 (en) | Intelligent control apparatus, system, and method of use | |
| CN106289290A (zh) | 一种路径导航系统及方法 | |
| CN104656665B (zh) | 一种新型无人机通用避障模块及步骤 | |
| CN109917786A (zh) | 一种面向复杂环境作业的机器人感知系统及系统运行方法 | |
| US20110046784A1 (en) | Asymmetric stereo vision system | |
| CN205507542U (zh) | 基于激光和视觉的道路自主清扫控制系统 | |
| CN109144057A (zh) | 一种基于实时环境建模和自主路径规划的导盲车 | |
| CN112461227B (zh) | 轮式底盘机器人巡检智能化自主导航方法 | |
| CN101750972A (zh) | 用于靠近自动机器使用的衣服 | |
| JPWO2006064544A1 (ja) | 自動車庫入れ装置 | |
| KR101575776B1 (ko) | 시각장애인용 사물인식 지팡이 | |
| CN105518377A (zh) | 一种气体泄漏的处理方法、装置及飞行器 | |
| CN104699102A (zh) | 一种无人机与智能车协同导航与侦查监控系统及方法 | |
| CN207037462U (zh) | 基于ros的agv小车嵌入式控制系统 | |
| CN107588780A (zh) | 一种智能导盲系统 | |
| CN113625707B (zh) | 一种多传感器融合的温室自动跟随平台及其控制方法 | |
| CN105387858B (zh) | 一种游艇智能导航系统及工作方法 | |
| CN102379277A (zh) | 智能驱鸟机器人 | |
| CN114322980A (zh) | 获取位置坐标及绘制电子地图的方法、计算机可读存储介质和自主作业设备 | |
| CN107797554A (zh) | 一种高精度智能放样小车 | |
| CN113566808A (zh) | 一种导航路径规划方法、装置、设备以及可读存储介质 | |
| CN114448114A (zh) | 基于移动机器人的智能无线供电系统 |
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 | ||
| TR01 | Transfer of patent right | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20171026 Address after: 238200 No. 3 building, standardized factory building, Ma'anshan Economic Development Zone, Anhui, China Patentee after: Anhui promise Robot Technology Co., Ltd. Address before: 150001 Harbin, Nangang, West District, large straight street, No. 92 Patentee before: Harbin Institute of Technology |