CN109144057A - 一种基于实时环境建模和自主路径规划的导盲车 - Google Patents
一种基于实时环境建模和自主路径规划的导盲车 Download PDFInfo
- Publication number
- CN109144057A CN109144057A CN201810888126.5A CN201810888126A CN109144057A CN 109144057 A CN109144057 A CN 109144057A CN 201810888126 A CN201810888126 A CN 201810888126A CN 109144057 A CN109144057 A CN 109144057A
- Authority
- CN
- China
- Prior art keywords
- module
- path planning
- slam
- real time
- autonomous path
- 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.)
- Pending
Links
- 230000033001 locomotion Effects 0.000 claims abstract description 30
- 230000007613 environmental effect Effects 0.000 claims abstract description 21
- 230000002452 interceptive effect Effects 0.000 claims abstract description 12
- 238000005259 measurement Methods 0.000 claims abstract description 10
- 230000005540 biological transmission Effects 0.000 claims abstract description 3
- 230000004438 eyesight Effects 0.000 claims description 26
- 230000001133 acceleration Effects 0.000 claims description 20
- 238000012545 processing Methods 0.000 claims description 18
- 230000004888 barrier function Effects 0.000 claims description 12
- 238000000034 method Methods 0.000 claims description 11
- 238000012546 transfer Methods 0.000 claims description 10
- 230000008569 process Effects 0.000 claims description 8
- 230000004927 fusion Effects 0.000 claims description 5
- 230000008859 change Effects 0.000 claims description 3
- 238000000605 extraction Methods 0.000 claims description 2
- 230000005611 electricity Effects 0.000 claims 1
- 238000004387 environmental modeling Methods 0.000 claims 1
- 239000004744 fabric Substances 0.000 claims 1
- 238000005516 engineering process Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 230000007547 defect Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 230000003993 interaction Effects 0.000 description 2
- 241000283070 Equus zebra Species 0.000 description 1
- 206010047571 Visual impairment Diseases 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 230000000386 athletic effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000004886 head movement Effects 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 230000035479 physiological effects, processes and functions Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 239000004575 stone Substances 0.000 description 1
- 208000029257 vision disease Diseases 0.000 description 1
- 230000004393 visual impairment Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H3/00—Appliances for aiding patients or disabled persons to walk about
- A61H3/06—Walking aids for blind persons
- A61H3/061—Walking aids for blind persons with electronic detecting or guiding means
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/36—Input/output arrangements for on-board computers
- G01C21/3605—Destination input or retrieval
- G01C21/3608—Destination input or retrieval using speech input, e.g. using speech recognition
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/36—Input/output arrangements for on-board computers
- G01C21/3626—Details of the output of route guidance instructions
- G01C21/3629—Guidance using speech or audio output, e.g. text-to-speech
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/027—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising intertial navigation means, e.g. azimuth detector
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5058—Sensors or detectors
- A61H2201/5084—Acceleration sensors
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5058—Sensors or detectors
- A61H2201/5092—Optical sensor
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Health & Medical Sciences (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Health & Medical Sciences (AREA)
- Audiology, Speech & Language Pathology (AREA)
- Pain & Pain Management (AREA)
- Public Health (AREA)
- Multimedia (AREA)
- Physical Education & Sports Medicine (AREA)
- Rehabilitation Therapy (AREA)
- Life Sciences & Earth Sciences (AREA)
- Animal Behavior & Ethology (AREA)
- Epidemiology (AREA)
- Veterinary Medicine (AREA)
- Acoustics & Sound (AREA)
- Artificial Intelligence (AREA)
- Human Computer Interaction (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明涉及一种基于实时环境建模和自主路径规划的导盲车,包括实时环境建模***,基于SLAM的自主路径规划***,语音人机交互***和手扶式移动引导平台;所述实时环境建模***与基于SLAM的自主路径规划***连接,将生成的SLAM环境地图三维模型和导盲车运动信息传输给基于SLAM的自主路径规划***;所述语音人机交互***连接基于SLAM的自主路径规划***,将盲人说出的目的地语音信息转换成确定的目的地信息传递给基于SLAM的自主路径规划***,所述基于SLAM的自主路径规划***能够根据规划的路径生成电机控制信号并传递给手扶式移动引导平台,控制手扶式移动引导平台按照规划路径移动。本发明具有高自主程度的导盲避障,更具实用性和高效性。
Description
技术领域
本发明涉及导盲设备领域,特别涉及一种基于实时环境建模和自主路径规划的导盲车。
背景技术
目前,盲人及视力存在缺陷的患者在中国占有较大比重,日益发达的交通和复杂的路况对此类人群的出行造成很大的困难。而盲道占用的情况在国内也非常常见。导盲犬是解决此问题的一种方法,但由于其高成本制约不能得到广泛普及,使盲人及视力存在缺陷的患者自我出行受到很大限制。而国内对导盲设备的研究和应用还较少,缺少实用性高安全性强的导盲设备。为了给盲人及视力缺陷人群提供出行的便利与安全性,摒弃导盲犬培养的高成本因素,集信息采集,决策判断和人机交互为一体的智能导盲设备也成为此类人群的另一个选择。
现有相关技术中大多存在使用环境局限性和导航避障智能自主化程度不高的不足。如已授权的发明专利CN105078720A一种智能导盲装置,采用GPS定位和超声波传感器,主要实现障碍物位置定位的功能,并不能智能自主进行路径规划和智能自主避障。如已授权发明专利CN102670383A基于图像识别技术的全自动可在载人盲车及控制方法,其采用的图像识别技术主要针对于盲道特征,对于盲道上的障碍物不能进行有效的路径规划避障,对于不具备盲道的道路不能实现有效的导盲避障。如已授权发明专利CN108042324A具有震动提醒功能的导盲设备,其检测到障碍物后通过震动等方式提醒盲人,躲避障碍物还需要依靠盲人自身,不能进行自主导盲避障。
综上所述,现有导盲设备相关技术,其使用环境局限于盲道道路或交通信号清晰的道路,且大多不具备智能自主路径规划,自主导盲避障的功能,并且由于盲人自身的生理缺陷,其判断能力和行动能力存在局限性,依靠现有导盲设备出行存在一定的安全隐患。
发明内容
针对现有技术存在的缺陷,本发明的目的在于提供一种基于实时环境建模和自主路径规划的导盲车,能够在复杂环境进行局部环境地图三维建模并进行自主路径规划和避障,该设备能够通过GPS信号和目的地信息生成全局路径导航信息,并能够在行进过程中建立的准确的环境三维模型并规划合理安全的局部路径来实现避障的功能,最终实现在不偏离全局路径的前提下实现局部路径的自主规划和导航避障功能。
为了实现上述目的,本发明采用如下技术方案:
一种基于实时环境建模和自主路径规划的导盲车,包括实时环境建模***,基于SLAM的自主路径规划***,语音人机交互***和手扶式移动引导平台;所述实时环境建模***与基于SLAM的自主路径规划***连接,将生成的SLAM环境地图三维模型和导盲车运动信息传输给基于SLAM的自主路径规划***;所述语音人机交互***连接基于SLAM的自主路径规划***,将盲人说出的目的地语音信息转换成确定的目的地信息传递给基于SLAM的自主路径规划***,所述基于SLAM的自主路径规划***能够根据规划的路径生成电机控制信号并传递给手扶式移动引导平台,控制手扶式移动引导平台按照规划路径移动。
所述实时环境建模***包括双目视觉模块,激光测距模块,IMU加速度传感模块和中央数据处理模块;所述中央数据处理模块将双目视觉模块处理后的图像特征信息和运动信息,激光测距模块扫描处理后的三维点云信息和IMU加速度传感模块采集的运动信息进行多传感器融合,生成SLAM环境地图三维模型并且得到导盲车的运动信息。
所述双目视觉模块包括双目相机和图像数据处理板卡,双目相机拍摄导盲车周围环境图像,图像数据处理板卡根据拍摄的图像信息获得环境特征信息和景深信息,并通过特征点提取和追踪实现小车运动状态的估计,以及小车在环境中位置的变化情况。其中双目相机的左右两个摄像头相对位置完全固定,两个摄像头的有效拍摄范围均为5米;两个摄像头能够同时以固定帧率拍摄导盲车前5m范围内的环境图像;特别的,环境信息还包括红绿灯、斑马线等关键标志物。
所述激光测距模块采用二维激光测距传感器、电动旋转台和激光数据处理板卡,二维激光测距传感器安装在电动旋转台上,通过旋转台的转动上下运动从而实现范围内环境的三维扫描,激光数据处理板卡将扫描的激光点云数据进行处理从而获得周围环境的三维点云图。其中二维激光测距传感器测量宽度范围为左右正负135度共270度,有效测量距离为5m,能够实现激光测距平面上5m内环境的实时扫描;特别的,通过电动旋转台带动二维激光扫描测距仪进行上下点头运动,能够完成范围内三维环境信息的扫描。
所述IMU加速度传感模块采用10自由度惯性传感器,采集小车运动过程中的加速度数据和角加速度数据,实现对导盲车运动姿态的实时评估。
所述中央数据处理模块能够将IMU加速度传感模块得到的运动状态数据与双目视觉模块得出的运动数据互相修正,并将激光测距模块扫描得到的三维环境信息、双目视觉模块和IMU加速度计传感模块互相修正得到的运动信息以及双目视觉模块得到的环境细节信息进行多传感器融合,根据导盲车修正后的运动信息,将行进过程中不同位置点由激光测距模块得到的环境三维点云图融合成完整的环境地图三维模型,准确建立5m范围内的三维环境模型,并且准确推算出导盲车在环境模型中特定时刻的具***置和运动情况,确保环境地图三维模型融合的准确性,确保小车运动状态及在环境地图三维模型中的位置信息的准确性。
所述基于SLAM的自主路径规划***包括GPS模块和中央控制模块;所述GPS模块获取小车的GPS信号,所述中央控制模块能够根据目的地信息和导盲车某时刻的GPS信号及内置的地图信息,得出较为合理的全局路径规划;特别的,在导盲车行进过程中,通过实时环境建模***建立的SLAM地图模型,中央控制模块能够对路径进行局部优化,有效躲避沿途的障碍物、车辆及行人,并根据双目视觉模块识别得到的交通信号及标志规划行进路线,在保证不偏离整体全局导航路径的前提下,实现自主路径规划和导航避障的功能,保证了盲人的出行安全性和高效性。
所述语音人机交互***,包括语音输入输出模块和语音识别模块;所述语音输入输出模块能够接受盲人的语音信号和发出语音提示,语音识别模块能够通过对盲人输入的目的地语音信号进行语音识别从而得到准确的目的地信息,并能够将目的地信息传递给基于SLAM的自主路径规划***进行全局路径规划。
所述手扶式移动引导平台,包括驱动模块和轮式移动平台。所述轮式移动平台的车身前部布置两个独立驱动车轮,后部布置两个万向轮;所述轮式移动平台前端安装有双目视觉模块的双目相机、激光测距模块的二维激光测距传感器和电动旋转台、IMU加速度传感模块;内部安装有双目视觉模块的图像数据处理板卡、激光测距模块的激光数据处理板卡、中央数据处理模块、基于SLAM的自主路径规划***和语音人机交互***的语音识别模块;所述轮式移动平台的手柄处安装有语音输入输出模块、电源按钮、独立报警按钮和防脱手绳;所述驱动模块包括驱动板和驱动电机,驱动模块安装在轮式移动平台内,驱动电机与轮式移动平台的驱动轮连接,驱动板根据基于SLAM的自主路径规划***的电机控制信号驱动电机带动轮式移动平台的两个驱动轮转动;特别的,两个独立的驱动轮能够通过差速实现轮式移动平台的转向控制。
本发明由于采用以上技术方案,使之与现有技术相比,具有以下优点和积极效果:
本发明提供的导盲车能够根据多传感器采集的环境信息进行实时地图三维建模及自主路径规划,能对静态及动态障碍物进行精确建模并规划路径进行障碍物规避,应用场景不局限于传统盲道。本发明提供的导盲车能够在不偏离全局路径的前提下能够在行进过程中进行实现智能自主导航避障,提高了导盲车的安全性和实用性。
附图说明
图1为导盲车组成部分示意图;
图2为导盲车整体结构布置示意图;
图3为导盲车工作流程图;
图4为具体典型避障导航案例示意图;
附图标号说明:
1.双目视觉模块 2.激光测距模块 3.IMU加速度传感模块 4.轮式移动平台 5.手柄6.电源按钮 7.独立报警按钮 8.语音输入输出模块 9.防脱手绳 10.驱动轮 11.万向轮。
具体实施方式
下面结合附图对本发明的具体实施例进一步说明。
如图1所示,本发明提出了一种基于实时环境建模和自主路径规划的导盲车,包括实时环境建模***,基于SLAM的自主路径规划***,语音人机交互***和手扶式移动引导平台;所述实时环境建模***与基于SLAM的自主路径规划***连接,将生成的SLAM环境地图三维模型和导盲车运动信息传输给基于SLAM的自主路径规划***;所述语音人机交互***连接基于SLAM的自主路径规划***,将盲人说出的目的地语音信息转换成确定的目的地信息传递给基于SLAM的自主路径规划***,所述基于SLAM的自主路径规划***能够根据规划的路径生成电机控制信号并传递给手扶式移动引导平台,控制手扶式移动引导平台按照规划路径移动。
所述实时环境建模***包括双目视觉模块,激光测距模块,IMU加速度传感模块和中央数据处理模块;所述中央数据处理模块将双目视觉模块处理后的图像特征信息和运动信息,激光测距模块扫描处理后的三维点云信息和IMU加速度传感模块采集的运动信息进行多传感器融合,生成SLAM环境地图三维模型并且得到导盲车的运动信息。
具体的,在本实施例中,如图2所示,双目视觉模块1采用两个BASLER-acA2500-60uc摄像头和图像数据处理板卡,双目视觉模块1的两个摄像头能够以20帧每秒的速度拍摄5m范围内环境的照片;图像数据处理板卡能够将双目相机拍摄的图像数据进行特征分析得到范围内的交通信号灯及交通标示信息,并能够通过基于图像特征识别与追踪算法获得导盲车的运动信息数据。
具体的,在本实施例中,激光测距模块2采用型号为UST-10LX的二维激光扫描仪、电动旋转台和激光数据处理板卡;二维激光扫描仪扫描宽度范围是正负135度,有效测量距离为5m,二维激光雷达能够在25ms内完成270度范围的环境信息扫描,结合电动旋转台的点头运动,能够实现范围内环境的三维扫描;激光数据处理板卡能够将不同角度下二维激光雷达扫描的平面数据融合成三维点云信息数据。
具体的,在本实施例中,IMU加速度传感模块3采用10自由度惯性传感器ADIS16488A,其能够提供正负0.1度旋转角度测量的精度和0.1G的加速度测量精度,能够准确的测量导盲车的运动状态。
具体的,中央数据处理模块采用高性能CPU,能够将IMU加速度传感模块3测量的导盲车运动状态与双目视觉模块1得出的导盲车运动状态进行相互修正;具体的,中央数据处理模块能够根据导盲车准确的运动信息和位置变化信息,由激光测距模块2在不同位置点扫描的三维点云信息融合成环境地图的三维模型。
特别的,基于SLAM的自主路径规划***,包括GPS定位模块和中央控制模块;GPS定位模块能够测的导盲车某时刻的GPS信息,中央控制模块能够根据GPS信息和由语音人机交互***传回的目的地信息,结合内置地图生成全局导航路线;特别的,基于SLAM的自主路径规划***能够在导盲开始后,接收实时环境建模***传过来的SLAM地图信息和导盲车运动信息,在不偏离全局路径的前提下,根据某时刻导盲车前5m范围内的环境地图三维模型进行局部路径规划实现导航避障的功能;特别的,基于SLAM的自主路径规划***能够根据规划的路径生成电机控制信号并传递给手扶式移动引导平台,控制引导平台按照规划路径移动。
特别的,语音人机交互***包括语音输入输出模块和语音识别模块,能够将盲人说出的目的地语音信息转换成确定的目的地信息传递给基于SLAM的自主路径规划***。
特别的,手扶式移动引导平台包括驱动模块和轮式移动平台;驱动模块安装在轮式移动平台内,驱动模块通过接收基于SLAM的自主路径规划***发出的电机控制信号,驱动电动机转动,从而带动轮式移动平台4运动。
如图2所示,轮式移动平台4前端为两个驱动轮10,通过前轮驱动带动手扶式移动引导平台运动,并能够通过差速实现手扶式移动引导平台的转向,后端为两个万向轮11用以平衡手扶式移动引导平台;轮式移动平台4的前端安装有双目视觉模块1的双目相机、激光测距模块2的二维激光传感器和IMU加速度传感模块3,从而能更有效的检测导盲车前端环境避免被遮挡;轮式移动平台4的内部安装有双目视觉模块1的图像数据处理板卡、激光测距模块2的激光数据处理板卡、中央数据处理模块、基于SLAM的自主路径规划***和手扶式移动引导平台的驱动模块;轮式移动平台4后端为手柄5,在手柄5末端有电源按钮6、独立报警按钮7、语音输入输出模块8和防脱手绳9。
如图3所示,本发明提出的基于实时环境建模和自主路径规划的导盲车的具体工作流程如下:
步骤一:在室外环境下,通过按下手柄上的电源按钮6启动导盲车,导盲车完成***自检后,使用者可以使用语音输入输出模块8说出目的地地点。
步骤二:语音识别模块确认目的地信息之后,基于SLAM的自主路径规划***会根据此时导盲车的GPS信号和目的地信息,根据内置的地图生成合适的全局步行导航路径。
步骤三:提示导航开始后,实时环境建模***同时启动,双目视觉模块的双目相机,激光测距模块中的二维激光测距扫描仪和IMU加速度传感模块开始对周围的环境进行扫描工作;实时环境建模***中的中央数据处理模块根据双目视觉模块中图像数据处理板卡处理后的环境特征信息和导盲车运动信息,激光测距模块中激光数据处理板卡处理后的三维环境点云信息和IMU加速度传感模块采集的导盲车运动信息,通过算法进行环境三维模型的建立。
步骤四:基于SLAM的自主路径规划***能够根据实时环境建模***建立的SLAM环境地图三维模型进行局部路径的规划来实现避障导航,具体如图4所示。
其中,图4a中当导盲车带领使用者行走至B路时,在B路上碰到石块或停放的自行车等障碍物,实时环境建模***将扫描到的障碍物信息建立到环境模型中。基于SLAM的自主路径规划***根据建立的环境三维模型,根据使用者安全优先的准则,自动选择合适的路径绕过障碍物,并返回到GPS导航主路径上,不会出现绕道绕圈等不合理行动;特别的,在行进过程中遇到悬空于路上方的树枝障碍物,实时环境建模***协同基于SLAM的自主路径规划***能有效的带领使用者绕过悬空的树枝障碍物,保证使用者的安全。
步骤五:基于SLAM的自主路径规划***能够根据局部规划后的路径,生成电动机控制信号,驱动手扶式移动引导平台的驱动模块工作,带动轮式移动平台按照规划路径进行移动。图4b中当D路因为临时施工等因素封闭时,且GPS导航信息未能及时更新路况信息,导盲车能根据建立的环境模型重新选择之前的路口进行折回,并配合GPS信号和导航软件重新计算全局路径,再重新开始实时环境建模和局部路径规划,保证使用者能到达预定的目的地。
步骤六:当导盲车在导航避障过程中,接到使用者修改目的地的信息后,基于SLAM的自主路径规划***会根据导盲车此时的GPS信号和新的目的地信息,重新进行导航路径生成,并重新开始实时环境建模和自主路径规划。
步骤七:目的地到达。
Claims (8)
1.一种基于实时环境建模和自主路径规划的导盲车,其特征在于:包括实时环境建模***,基于SLAM的自主路径规划***,语音人机交互***和手扶式移动引导平台;所述实时环境建模***与基于SLAM的自主路径规划***连接,将生成的SLAM环境地图三维模型和导盲车运动信息传输给基于SLAM的自主路径规划***;所述语音人机交互***连接基于SLAM的自主路径规划***,将盲人说出的目的地语音信息转换成确定的目的地信息传递给基于SLAM的自主路径规划***,所述基于SLAM的自主路径规划***能够根据规划的路径生成电机控制信号并传递给手扶式移动引导平台,控制手扶式移动引导平台按照规划路径移动。
2.根据权利要求1所述的基于实时环境建模和自主路径规划的导盲车,其特征在于:所述实时环境建模***包括双目视觉模块,激光测距模块,IMU加速度传感模块和中央数据处理模块;所述中央数据处理模块将双目视觉模块处理后的图像特征信息和运动信息,激光测距模块扫描处理后的三维点云信息和IMU加速度传感模块采集的运动信息进行多传感器融合,生成SLAM环境地图三维模型并且得到导盲车的运动信息。
3.根据权利要求2所述的基于实时环境建模和自主路径规划的导盲车,其特征在于:所述双目视觉模块包括双目相机和图像数据处理板卡,双目相机拍摄导盲车周围环境图像,图像数据处理板卡根据拍摄的图像信息获得环境特征信息和景深信息,并通过特征点提取和追踪实现小车运动状态的估计,以及小车在环境中位置的变化情况。
4.根据权利要求2所述的基于实时环境建模和自主路径规划的导盲车,其特征在于:所述激光测距模块采用二维激光测距传感器、电动旋转台和激光数据处理板卡,二维激光测距传感器安装在电动旋转台上,通过旋转台的转动上下运动从而实现范围内环境的三维扫描,激光数据处理板卡将扫描的激光点云数据进行处理从而获得周围环境的三维点云图。
5.根据权利要求2所述的基于实时环境建模和自主路径规划的导盲车,其特征在于:所述IMU加速度传感模块采用10自由度惯性传感器,能够精确测量导盲车的运动情况。
6.根据权利要求1所述的基于实时环境建模和自主路径规划的导盲车,其特征在于:所述基于SLAM的自主路径规划***包括GPS模块和中央控制模块;所述GPS模块获取小车的GPS信号,所述中央控制模块根据小车的GPS信号和内置地图生成全局导航路径,同时,在行走过程中根据SLAM地图信息规划局部路径来实现避障并生成运动控制信号,从而控制导盲车合理绕行障碍物,在不偏离主要导航路径的前提下完成局部自主安全避障导航。
7.根据权利要求1所述的基于实时环境建模和自主路径规划的导盲车,其特征在于:所述语音人机交互***包括语音输入输出模块和语音识别模块;所述语音输入输出模块能够接受盲人的语音信号和发出语音提示;所述语音识别模块能够识别盲人说出的目的地语音信息中的目的地信息。
8.根据权利要求1所述的基于实时环境建模和自主路径规划的导盲车,其特征在于:所述手扶式移动引导平台,包括驱动模块和轮式移动平台;所述轮式移动平台的车身前部布置两个独立驱动车轮,后部布置两个万向轮;所述轮式移动平台前端安装有双目视觉模块的双目相机、激光测距模块的二维激光测距传感器和电动旋转台以及IMU加速度传感模块;内部安装有双目视觉模块的图像数据处理板卡、激光测距模块的激光数据处理板卡、中央数据处理模块、基于SLAM的自主路径规划***和语音人机交互***的语音识别模块;所述轮式移动平台的手柄处安装有语音输入输出模块、电源按钮、独立报警按钮和防脱手绳;所述驱动模块包括驱动板和驱动电机,驱动模块安装在轮式移动平台内,驱动电机与轮式移动平台的驱动轮连接,驱动板根据基于SLAM的自主路径规划***的电机控制信号驱动电机带动轮式移动平台的两个驱动轮转动;其中,两个独立的驱动轮能够通过差速实现轮式移动平台的转向控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810888126.5A CN109144057A (zh) | 2018-08-07 | 2018-08-07 | 一种基于实时环境建模和自主路径规划的导盲车 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810888126.5A CN109144057A (zh) | 2018-08-07 | 2018-08-07 | 一种基于实时环境建模和自主路径规划的导盲车 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109144057A true CN109144057A (zh) | 2019-01-04 |
Family
ID=64792041
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810888126.5A Pending CN109144057A (zh) | 2018-08-07 | 2018-08-07 | 一种基于实时环境建模和自主路径规划的导盲车 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109144057A (zh) |
Cited By (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110398972A (zh) * | 2019-08-08 | 2019-11-01 | 上海大学 | 一种自主配送外卖机器人 |
CN110491155A (zh) * | 2019-07-30 | 2019-11-22 | 深圳市前海胡桃科技有限公司 | 一种自动驾驶装置的调度方法、装置及自动驾驶装置 |
CN110478206A (zh) * | 2019-09-10 | 2019-11-22 | 李少阳 | 一种智能导盲***及设备 |
CN111035544A (zh) * | 2019-12-26 | 2020-04-21 | 吕日鹏 | 盲人导航*** |
CN111142536A (zh) * | 2020-01-06 | 2020-05-12 | 华南师范大学 | 一种室内导盲机器人 |
CN111228090A (zh) * | 2020-01-14 | 2020-06-05 | 卡登米(珠海)智能科技有限公司 | 导盲寻路方法和装置 |
CN111966088A (zh) * | 2020-07-14 | 2020-11-20 | 合肥工业大学 | 一种自动驾驶儿童玩具车控制***及控制方法 |
CN112034861A (zh) * | 2020-09-15 | 2020-12-04 | 航天科工智能机器人有限责任公司 | 一种仿生自主机器人自主避障***及其避障方法 |
WO2020258721A1 (zh) * | 2019-06-27 | 2020-12-30 | 广东利元亨智能装备股份有限公司 | 智能巡航车导航方法及*** |
CN112587378A (zh) * | 2020-12-11 | 2021-04-02 | 中国科学院深圳先进技术研究院 | 基于视觉的外骨骼机器人足迹规划***、方法及存储介质 |
CN112932911A (zh) * | 2021-04-02 | 2021-06-11 | 常州大学怀德学院 | 基于混合感知***的导盲机器人 |
WO2021147546A1 (zh) * | 2020-01-20 | 2021-07-29 | 深圳市普渡科技有限公司 | 多传感器融合slam***、多传感器融合方法及机器人、介质 |
CN113253731A (zh) * | 2021-05-26 | 2021-08-13 | 常州市工业互联网研究院有限公司 | 基于slam算法的自组织路径的可移动式嵌入式自动化平台 |
CN113370225A (zh) * | 2021-05-31 | 2021-09-10 | 山东新一代信息产业技术研究院有限公司 | 一种盲人引导服务机器人*** |
CN113520812A (zh) * | 2021-08-26 | 2021-10-22 | 山东大学 | 一种四足机器人导盲***及方法 |
CN113671959A (zh) * | 2021-08-19 | 2021-11-19 | 成都视海芯图微电子有限公司 | 一种辅助运动支架的控制方法、装置及Soc*** |
CN113701715A (zh) * | 2021-09-25 | 2021-11-26 | 山东科技大学 | 一种全自动深基坑测斜车 |
CN113749915A (zh) * | 2021-10-13 | 2021-12-07 | 中国计量大学 | 一种场景复现的导盲方法与*** |
CN114712181A (zh) * | 2022-05-07 | 2022-07-08 | 河海大学 | 一种基于视觉slam的盲人避障导航*** |
CN115416047A (zh) * | 2022-09-02 | 2022-12-02 | 北京化工大学 | 一种基于多传感器四足机器人的助盲***和方法 |
CN115416047B (zh) * | 2022-09-02 | 2024-06-25 | 北京化工大学 | 一种基于多传感器四足机器人的助盲***和方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103338735A (zh) * | 2011-01-26 | 2013-10-02 | 株式会社富圣再生 | 用于视障人的道路引导*** |
KR101497096B1 (ko) * | 2014-02-25 | 2015-03-03 | 경남대학교 산학협력단 | 시각장애인용 쇼핑 도우미 로봇 |
CN105403222A (zh) * | 2015-12-08 | 2016-03-16 | 江苏科技大学 | 基于ros的多导盲机器人及在未知环境中的地图创建方法 |
CN106890067A (zh) * | 2017-01-06 | 2017-06-27 | 南京邮电大学 | 室内盲人导航机器人 |
CN206543260U (zh) * | 2016-08-12 | 2017-10-10 | 陈星兆 | 一种导盲机器人 |
CN107390703A (zh) * | 2017-09-12 | 2017-11-24 | 北京创享高科科技有限公司 | 一种智能化导盲机器人及其导盲方法 |
CN207281590U (zh) * | 2017-09-12 | 2018-04-27 | 北京创享高科科技有限公司 | 一种智能化导盲机器人装置 |
CN108042324A (zh) * | 2017-12-12 | 2018-05-18 | 成都觅瑞科技有限公司 | 具有震动提醒功能的导盲设备 |
-
2018
- 2018-08-07 CN CN201810888126.5A patent/CN109144057A/zh active Pending
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103338735A (zh) * | 2011-01-26 | 2013-10-02 | 株式会社富圣再生 | 用于视障人的道路引导*** |
KR101497096B1 (ko) * | 2014-02-25 | 2015-03-03 | 경남대학교 산학협력단 | 시각장애인용 쇼핑 도우미 로봇 |
CN105403222A (zh) * | 2015-12-08 | 2016-03-16 | 江苏科技大学 | 基于ros的多导盲机器人及在未知环境中的地图创建方法 |
CN206543260U (zh) * | 2016-08-12 | 2017-10-10 | 陈星兆 | 一种导盲机器人 |
CN106890067A (zh) * | 2017-01-06 | 2017-06-27 | 南京邮电大学 | 室内盲人导航机器人 |
CN107390703A (zh) * | 2017-09-12 | 2017-11-24 | 北京创享高科科技有限公司 | 一种智能化导盲机器人及其导盲方法 |
CN207281590U (zh) * | 2017-09-12 | 2018-04-27 | 北京创享高科科技有限公司 | 一种智能化导盲机器人装置 |
CN108042324A (zh) * | 2017-12-12 | 2018-05-18 | 成都觅瑞科技有限公司 | 具有震动提醒功能的导盲设备 |
Cited By (27)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020258721A1 (zh) * | 2019-06-27 | 2020-12-30 | 广东利元亨智能装备股份有限公司 | 智能巡航车导航方法及*** |
CN110491155A (zh) * | 2019-07-30 | 2019-11-22 | 深圳市前海胡桃科技有限公司 | 一种自动驾驶装置的调度方法、装置及自动驾驶装置 |
CN110398972A (zh) * | 2019-08-08 | 2019-11-01 | 上海大学 | 一种自主配送外卖机器人 |
CN110398972B (zh) * | 2019-08-08 | 2021-03-23 | 上海大学 | 一种自主配送外卖机器人 |
CN110478206A (zh) * | 2019-09-10 | 2019-11-22 | 李少阳 | 一种智能导盲***及设备 |
CN110478206B (zh) * | 2019-09-10 | 2022-02-15 | 李少阳 | 一种智能导盲***及设备 |
CN111035544A (zh) * | 2019-12-26 | 2020-04-21 | 吕日鹏 | 盲人导航*** |
CN111142536A (zh) * | 2020-01-06 | 2020-05-12 | 华南师范大学 | 一种室内导盲机器人 |
CN111228090A (zh) * | 2020-01-14 | 2020-06-05 | 卡登米(珠海)智能科技有限公司 | 导盲寻路方法和装置 |
WO2021147546A1 (zh) * | 2020-01-20 | 2021-07-29 | 深圳市普渡科技有限公司 | 多传感器融合slam***、多传感器融合方法及机器人、介质 |
CN111966088A (zh) * | 2020-07-14 | 2020-11-20 | 合肥工业大学 | 一种自动驾驶儿童玩具车控制***及控制方法 |
CN111966088B (zh) * | 2020-07-14 | 2022-04-05 | 合肥工业大学 | 一种自动驾驶儿童玩具车控制***及控制方法 |
CN112034861A (zh) * | 2020-09-15 | 2020-12-04 | 航天科工智能机器人有限责任公司 | 一种仿生自主机器人自主避障***及其避障方法 |
CN112587378A (zh) * | 2020-12-11 | 2021-04-02 | 中国科学院深圳先进技术研究院 | 基于视觉的外骨骼机器人足迹规划***、方法及存储介质 |
CN112587378B (zh) * | 2020-12-11 | 2022-06-07 | 中国科学院深圳先进技术研究院 | 基于视觉的外骨骼机器人足迹规划***、方法及存储介质 |
CN112932911A (zh) * | 2021-04-02 | 2021-06-11 | 常州大学怀德学院 | 基于混合感知***的导盲机器人 |
CN113253731B (zh) * | 2021-05-26 | 2022-11-11 | 常州市工业互联网研究院有限公司 | 基于slam算法的自组织路径的可移动式嵌入式自动化平台 |
CN113253731A (zh) * | 2021-05-26 | 2021-08-13 | 常州市工业互联网研究院有限公司 | 基于slam算法的自组织路径的可移动式嵌入式自动化平台 |
CN113370225A (zh) * | 2021-05-31 | 2021-09-10 | 山东新一代信息产业技术研究院有限公司 | 一种盲人引导服务机器人*** |
CN113671959A (zh) * | 2021-08-19 | 2021-11-19 | 成都视海芯图微电子有限公司 | 一种辅助运动支架的控制方法、装置及Soc*** |
CN113520812A (zh) * | 2021-08-26 | 2021-10-22 | 山东大学 | 一种四足机器人导盲***及方法 |
CN113701715A (zh) * | 2021-09-25 | 2021-11-26 | 山东科技大学 | 一种全自动深基坑测斜车 |
CN113749915A (zh) * | 2021-10-13 | 2021-12-07 | 中国计量大学 | 一种场景复现的导盲方法与*** |
CN113749915B (zh) * | 2021-10-13 | 2023-09-01 | 中国计量大学 | 一种场景复现的导盲方法与*** |
CN114712181A (zh) * | 2022-05-07 | 2022-07-08 | 河海大学 | 一种基于视觉slam的盲人避障导航*** |
CN115416047A (zh) * | 2022-09-02 | 2022-12-02 | 北京化工大学 | 一种基于多传感器四足机器人的助盲***和方法 |
CN115416047B (zh) * | 2022-09-02 | 2024-06-25 | 北京化工大学 | 一种基于多传感器四足机器人的助盲***和方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109144057A (zh) | 一种基于实时环境建模和自主路径规划的导盲车 | |
CN111736603B (zh) | 一种无人驾驶清扫车及其长距离贴边清扫方法 | |
JP7125214B2 (ja) | プログラムおよびコンピューティングデバイス | |
CN105946853B (zh) | 基于多传感器融合的长距离自动泊车的***及方法 | |
JP2023134478A (ja) | ナビゲーション情報を匿名化するためのシステム及び方法 | |
JP6882296B2 (ja) | 自律視覚ナビゲーション | |
CN106114513B (zh) | 误识别判定装置 | |
CN110275540A (zh) | 用于扫地机器人的语义导航方法及其*** | |
CN107144285A (zh) | 位姿信息确定方法、装置和可移动设备 | |
US20190278273A1 (en) | Odometry system and method for tracking traffic lights | |
CN107145578A (zh) | 地图构建方法、装置、设备和*** | |
CN109917786A (zh) | 一种面向复杂环境作业的机器人感知***及***运行方法 | |
CN107600067A (zh) | 一种基于多视觉惯导融合的自主泊车***及方法 | |
CN106598039B (zh) | 一种基于激光雷达的变电站巡检机器人避障方法 | |
CN107636546A (zh) | 自主移动*** | |
CN105835878A (zh) | 在乘员视野和传感器检测受阻环境中的自主车辆操作 | |
CN109541535A (zh) | 一种基于uwb和视觉slam的agv室内定位及导航的方法 | |
CN109822596A (zh) | 一种服务机器人及其控制*** | |
KR101575776B1 (ko) | 시각장애인용 사물인식 지팡이 | |
JP2011138502A (ja) | 区域分解を用いるエリア・カバレッジ・システムおよび方法 | |
CN109086277A (zh) | 一种重叠区构建地图方法、***、移动终端及存储介质 | |
CN110293965A (zh) | 泊车方法和控制装置、车载设备及计算机可读介质 | |
CN107657825A (zh) | 泊车方法及装置 | |
CN207965645U (zh) | 一种机器人自主导航*** | |
CN109106563A (zh) | 一种基于深度学习算法的自动化导盲装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190104 |