CN114485682A - 一种基于slam技术的定位方法 - Google Patents

一种基于slam技术的定位方法 Download PDF

Info

Publication number
CN114485682A
CN114485682A CN202111650459.2A CN202111650459A CN114485682A CN 114485682 A CN114485682 A CN 114485682A CN 202111650459 A CN202111650459 A CN 202111650459A CN 114485682 A CN114485682 A CN 114485682A
Authority
CN
China
Prior art keywords
light
signal device
emitting
signal
emitting signal
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
Application number
CN202111650459.2A
Other languages
English (en)
Other versions
CN114485682B (zh
Inventor
李森林
余俊
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Wuhan Kotei Informatics Co Ltd
Original Assignee
Wuhan Kotei Informatics Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Wuhan Kotei Informatics Co Ltd filed Critical Wuhan Kotei Informatics Co Ltd
Priority to CN202111650459.2A priority Critical patent/CN114485682B/zh
Publication of CN114485682A publication Critical patent/CN114485682A/zh
Application granted granted Critical
Publication of CN114485682B publication Critical patent/CN114485682B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • 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/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • G01C21/30—Map- or contour-matching
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02B—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO BUILDINGS, e.g. HOUSING, HOUSE APPLIANCES OR RELATED END-USER APPLICATIONS
    • Y02B20/00—Energy efficient lighting technologies, e.g. halogen lamps or gas discharge lamps
    • Y02B20/40—Control techniques providing energy savings, e.g. smart controller or presence detection

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

本发明涉及一种基于SLAM技术的定位方法，包括：S1，在需要定位的物理空间内布置发光信号装置，并记录发光信号装置的三维地图坐标及其所在平面的法线；所述发光信号装置按照指定周期向外发射编码信号；S2，待定位设备在静止状态下以视频流方式采集一个完整周期内发光信号装置的编码信号；基于SLAM技术获取目标发光信号装置的SLAM坐标P1及其所在平面的法线N1，并根据编码信号获取目标发光信号装置的三维地图坐标P2及其所在平面的法线N2；S3，根据P1、P2、N1、N2计算待定位设备的在三维地图坐标系下的坐标及位姿。本技术方案不依赖GPS等卫星定位系统，结合SLAM技术能够适应各种复杂场景的定位，整体设备简单，成本大大降低。

Description

一种基于SLAM技术的定位方法
技术领域
本发明涉及导航定位技术领域，具体涉及一种基于SLAM技术的定位方法。
背景技术
在汽车智能驾驶和机器人应用领域，准确的定位是关键的基础功能。GPS等定位在室内信号可能被阻断，在复杂背景的场合视频定位有不能准确识别位置的问题，普通的SLAM定位使用过程中存在丢失跟踪的风险。
发明内容
本发明针对现有技术中存在的技术问题，提供一种由发光二级管信号装置作为定位航标结合SLAM定位技术的系统方案，解决现有导航定位技术中存在的问题。该方案还可以作为交通信号灯的辅助装置，为智能汽车提供定位信息的同时提供红绿灯信号。
本发明解决上述技术问题的技术方案如下：一种基于SLAM技术的定位方法，包括：
S1，在需要定位的物理空间内布置发光信号装置，并记录发光信号装置的三维地图坐标及其所在平面的法线；所述发光信号装置按照指定周期向外发射编码信号；
S2，待定位设备在静止状态下以视频流方式采集一个完整周期内发光信号装置的编码信号；基于SLAM技术获取目标发光信号装置的SLAM坐标P1及其所在平面的法线N1，并根据编码信号获取目标发光信号装置的三维地图坐标P2及其所在平面的法线N2；
S3，根据P1、P2、N1、N2计算待定位设备的在三维地图坐标系下的坐标及位姿。
进一步的，所述步骤S2还包括：
待定位设备在运动状态下，根据自身运动状态，预测目标发光装置在视频流中每一视频帧中的位置，并根据一个完整周期内所采集的视频流获取目标发光信号装置的编码信号。
进一步的，所述发光信号装置的出射光光轴与所在平面的法线平行。
进一步的，若待定位设备检测到某一发光信号装置所在平面的法线与铅垂线平行，则需要再采集一个发光信号装置的SLAM坐标及其三维地图坐标进行定位，且过这两个SLAM坐标的连线不平行于铅垂线。
进一步的，所述发光信号装置通过控制光源的点亮熄灭状态以及发光时间长度，按照一定周期向外部发射编码信号，所述编码信号包括发光信号装置的标识信息。
进一步的，所述编码信息中还包括校验码。
进一步的，所述发光信号装置为发光二极管。
进一步的，所述发光信号装置组通过接收外部刺激信号启动工作，所述外部刺激包括特定的音频信号或光信号。
本发明的有益效果是：本技术方案不依赖GPS等卫星定位系统，能够适应各种复杂场景的定位，整体设备简单，成本大大降低。
附图说明
图1为本发明实施例提供的一种基于SLAM技术的定位方法流程图；
图2为本发明实施例提供的定位系统结构示意图。
具体实施方式
以下结合附图对本发明的原理和特征进行描述，所举实例只用于解释本发明，并非用于限定本发明的范围。
图1为本发明实施例提供的一种基于SLAM技术的定位方法流程图。如图1所示，该方法包括以下步骤：
S1，在需要定位的物理空间内布置发光信号装置，并记录发光信号装置的三维地图坐标及其所在平面的法线；所述发光信号装置按照指定周期向外发射编码信号。
发光信号装置应具备以下特征：
1，在需要定位的物理空间内均匀布置发光信号装置；
2，发光信号装置必须镶嵌在平面内，发光二级管发出的光线必须与该平面的法线平行；
3，对每个发光信号装置进行编号，该编号不重复；
4，测量和搜集每个发光信号装置的三维地图坐标P2和所在平面的法线N2；
5，每个发光信号装置通过控制发光二级管通过熄灭和发光状态及时间间隔，以固定地时钟频率F1，循环向外发出编码信号；
6，发光二极管发出的光的颜色RGB值在范围M以内；
7，编码信号的主要内容是发光信号装置的编号，同时也可包含其它信息，如交通灯状态、地理坐标等。
8，编码信号的编码必须有校验码机制，避免受到其它光源的干扰；
9，发光信号装置所在的三维地图坐标系和定位装置的SLAM坐标系都必须各有一个坐标轴平行于铅垂线。
除此之外，为节省电力或避免造成光线污染，发光信号装置还能可以通过声音和光照来控制工作状态，在接收到外部声音或光照刺激后，再发出编码信号。
S2，待定位设备在静止状态下以视频流方式采集一个完整周期内发光信号装置的编码信号；基于SLAM技术获取目标发光信号装置的SLAM坐标P1及其所在平面的法线N1，并根据编码信号获取目标发光信号装置的三维地图坐标P2及其所在平面的法线N2。
待定位设备具备SLAM功能，有完整的摄像头功能以及具备执行定位算法的能力。
待定位设备在摄像头接收的视频流中检测发光编码信号；检测到发光信号源，并记录一个编码信号周期以上的信号流，若图像中发光信号装置所在像素点的像素颜色RGB值范围M以内，且能够正常解码获取编码信息，记录视频流中该发光信号装置的SLAM坐标P1及其所在平面的法线N1。
S3，根据P1、P2、N1、N2计算待定位设备的在三维地图坐标系下的坐标及位姿。
根据解码获得的编码信息可以获得发光信号装置对应的编号，根据编号查询预先记录的发光信号装置的三维地图坐标P2和所在平面的法线N2。然后根据P1、P2、N1、N2计算待定位设备的在三维地图坐标系下的坐标及位姿。
这里还需注意的是，若待定位设备检测到某一发光信号装置所在平面的法线与铅垂线平行，则需要再采集一个发光信号装置的SLAM坐标及其三维地图坐标进行定位，且过这两个SLAM坐标的直线不能平行于铅垂线。
另外，通过检测上一帧画面内的RGB值范围在M内的光点L1，并计算L1的SLAM坐标P3，然后在下一帧画面内P3对应的像素位置观测RGB值范围是否在M内判断L1的亮灭状态，可以实现在待定位设备处于移动状态下的对包括尚未识别编号的发光信号装置的连续跟踪。可以解决待定位设备在移动时，发光信号装置在定位设备的画面中的像素位置变化的问题，实现对发光信号装置的连续观测并记录它发出的完整信号，进而实现对发光信号装置的编号识别和附加信息的读取。
尽管已描述了本发明的优选实施例，但本领域内的技术人员一旦得知了基本创造概念，则可对这些实施例做出另外的变更和修改。所以，所附权利要求意欲解释为包括优选实施例以及落入本发明范围的所有变更和修改。
显然，本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样，倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内，则本发明也意图包括这些改动和变型在内。

Claims (8)

1.一种基于SLAM技术的定位方法，其特征在于，包括：
S1，在需要定位的物理空间内布置发光信号装置，并记录发光信号装置的三维地图坐标及其所在平面的法线；所述发光信号装置按照指定周期向外发射编码信号；
S2，待定位设备在静止状态下以视频流方式采集一个完整周期内发光信号装置的编码信号；基于SLAM技术获取目标发光信号装置的SLAM坐标P1及其所在平面的法线N1，并根据编码信号获取目标发光信号装置的三维地图坐标P2及其所在平面的法线N2；
S3，根据P1、P2、N1、N2计算待定位设备的在三维地图坐标系下的坐标及位姿。
2.根据权利要求1所述的方法，其特征在于，所述步骤S2还包括：
待定位设备在运动状态下，根据自身运动状态，预测目标发光装置在视频流中每一视频帧中的位置，并根据一个完整周期内所采集的视频流获取目标发光信号装置的编码信号。
3.根据权利要求1所述的方法，其特征在于，所述发光信号装置的出射光光轴与所在平面的法线平行。
4.根据权利要求3所述的方法，其特征在于，若待定位设备检测到某一发光信号装置所在平面的法线与铅垂线平行，则需要再采集一个发光信号装置的SLAM坐标及其三维地图坐标进行定位，且过这两个SLAM坐标的连线不平行于铅垂线。
5.根据权利要求1所述的方法，其特征在于，所述发光信号装置通过控制光源的点亮熄灭状态以及发光时间长度，按照一定周期向外部发射编码信号，所述编码信号包括发光信号装置的标识信息。
6.根据权利要求5所述的方法，其特征在于，所述编码信息中还包括校验码。
7.根据权利要求1所述的方法，其特征在于，所述发光信号装置为发光二极管。
8.根据权利要求1所述的方法，其特征在于，所述发光信号装置组通过接收外部刺激信号启动工作，所述外部刺激包括特定的音频信号或光信号。
CN202111650459.2A 2021-12-30 2021-12-30 一种基于slam技术的定位方法 Active CN114485682B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111650459.2A CN114485682B (zh) 2021-12-30 2021-12-30 一种基于slam技术的定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111650459.2A CN114485682B (zh) 2021-12-30 2021-12-30 一种基于slam技术的定位方法

Publications (2)

Publication Number Publication Date
CN114485682A true CN114485682A (zh) 2022-05-13
CN114485682B CN114485682B (zh) 2023-06-27

Family

ID=81507622

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111650459.2A Active CN114485682B (zh) 2021-12-30 2021-12-30 一种基于slam技术的定位方法

Country Status (1)

Country Link
CN (1) CN114485682B (zh)

Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007218813A (ja) * 2006-02-20 2007-08-30 Casio Comput Co Ltd 情報伝送システム、撮像装置、経路案内方法、及び、経路案内プログラム
JP2012043090A (ja) * 2010-08-17 2012-03-01 Denso Corp 車載情報取得装置
CN106595639A (zh) * 2016-12-27 2017-04-26 纳恩博（北京）科技有限公司 定位系统及其定位方法和装置及机器人
CN106767822A (zh) * 2016-12-07 2017-05-31 北京邮电大学 基于相机通信与图像定位技术的室内定位系统及方法
CN107063266A (zh) * 2017-05-05 2017-08-18 江苏易恩特机电设备有限公司 基于室内led灯和智能手机摄像头实现室内定位的方法
CN108139213A (zh) * 2016-08-19 2018-06-08 广州艾若博机器人科技有限公司 基于发光设备的地图构建方法、纠正方法及装置
US20190178654A1 (en) * 2016-08-04 2019-06-13 Reification Inc. Methods for simultaneous localization and mapping (slam) and related apparatus and systems
CN109949365A (zh) * 2019-03-01 2019-06-28 武汉光庭科技有限公司 基于路面特征点的车辆指定位置停车方法及系统
US20190265722A1 (en) * 2018-02-23 2019-08-29 Crown Equipment Corporation Systems and methods for optical target based indoor vehicle navigation
CN111220949A (zh) * 2020-03-03 2020-06-02 吴思雨 一种基于led光源的无人系统空间定位方法
US20210191421A1 (en) * 2019-12-24 2021-06-24 Ubtech Robotics Corp Ltd Autonomous mobile apparatus and control method thereof
WO2021164712A1 (zh) * 2020-02-19 2021-08-26 Oppo广东移动通信有限公司 位姿跟踪方法、可穿戴设备、移动设备以及存储介质
CN113807435A (zh) * 2021-09-16 2021-12-17 中国电子科技集团公司第五十四研究所 一种基于多传感器的遥感图像特征点高程获取方法

Patent Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007218813A (ja) * 2006-02-20 2007-08-30 Casio Comput Co Ltd 情報伝送システム、撮像装置、経路案内方法、及び、経路案内プログラム
JP2012043090A (ja) * 2010-08-17 2012-03-01 Denso Corp 車載情報取得装置
US20190178654A1 (en) * 2016-08-04 2019-06-13 Reification Inc. Methods for simultaneous localization and mapping (slam) and related apparatus and systems
CN108139213A (zh) * 2016-08-19 2018-06-08 广州艾若博机器人科技有限公司 基于发光设备的地图构建方法、纠正方法及装置
CN106767822A (zh) * 2016-12-07 2017-05-31 北京邮电大学 基于相机通信与图像定位技术的室内定位系统及方法
CN106595639A (zh) * 2016-12-27 2017-04-26 纳恩博（北京）科技有限公司 定位系统及其定位方法和装置及机器人
CN107063266A (zh) * 2017-05-05 2017-08-18 江苏易恩特机电设备有限公司 基于室内led灯和智能手机摄像头实现室内定位的方法
US20190265722A1 (en) * 2018-02-23 2019-08-29 Crown Equipment Corporation Systems and methods for optical target based indoor vehicle navigation
CN109949365A (zh) * 2019-03-01 2019-06-28 武汉光庭科技有限公司 基于路面特征点的车辆指定位置停车方法及系统
US20210191421A1 (en) * 2019-12-24 2021-06-24 Ubtech Robotics Corp Ltd Autonomous mobile apparatus and control method thereof
WO2021164712A1 (zh) * 2020-02-19 2021-08-26 Oppo广东移动通信有限公司 位姿跟踪方法、可穿戴设备、移动设备以及存储介质
CN111220949A (zh) * 2020-03-03 2020-06-02 吴思雨 一种基于led光源的无人系统空间定位方法
CN113807435A (zh) * 2021-09-16 2021-12-17 中国电子科技集团公司第五十四研究所 一种基于多传感器的遥感图像特征点高程获取方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
王语琪;巩应奎;: "一种基于视觉信息的可见光通信室内定位方法", vol. 26, no. 01, pages 200 - 204 *

Also Published As

Publication number Publication date
CN114485682B (zh) 2023-06-27

Similar Documents

Publication Publication Date Title
Fang et al. High-speed indoor navigation system based on visible light and mobile phone
KR100669250B1 (ko) 인공표식 기반의 실시간 위치산출 시스템 및 방법
CN1950285B (zh) 用于移动平台的定位系统和方法
CN107835050B (zh) 一种基于可见光通信的定位方法及系统
US20140199082A1 (en) Information provision system, server system, terminal device, information provision method, and recording medium
US20120126721A1 (en) Gps-based lighting control system
CN105358938A (zh) 距离或者位置确定
JP2016538794A (ja) 可視光源、モバイル端末、及びコントローラに基づく位置決定方法
CN105378503A (zh) 确定取向
US20170351263A1 (en) Roadway-Infrastructure-Maintenance System Using Automated Vehicles
CN109387810A (zh) 一种室内定位系统
CN102901512A (zh) 导航装置及系统
CN111103579A (zh) 一种基于手机摄像头的可见光室内定位系统及定位方法
US20190196499A1 (en) System and method for providing overhead camera-based precision localization for intelligent vehicles
CN106932770A (zh) 一种基于led灯的室内定位系统及方法
CN103033792A (zh) 信息取得装置、信息取得方法、程序以及信息取得系统
JP2011134058A (ja) 光学式自己位置検知装置及び方法
CN107105408A (zh) 一种基于可见光通信的定位方法、装置及系统
CN111052021A (zh) 室内移动物体定位系统
CN114485682B (zh) 一种基于slam技术的定位方法
CN108563221A (zh) 一种基于可见光通信和ros的自动驾驶方法及其驾驶系统
CN204155294U (zh) 桌面智能识别系统
CN109241971A (zh) 一种城轨列车车号识别系统
JP2012054689A (ja) 可視光データ処理装置、可視光通信システム、可視光データ処理方法及びそのプログラム
CN110531318B (zh) 一种用于可见光成像室内定位扩展发光单元id的方法

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
GR01 Patent grant
GR01 Patent grant