CN110865335B - 一种室内定位系统及控制方法 - Google Patents
一种室内定位系统及控制方法 Download PDFInfo
- Publication number
- CN110865335B CN110865335B CN201911139965.8A CN201911139965A CN110865335B CN 110865335 B CN110865335 B CN 110865335B CN 201911139965 A CN201911139965 A CN 201911139965A CN 110865335 B CN110865335 B CN 110865335B
- Authority
- CN
- China
- Prior art keywords
- laser
- infrared receiving
- laser beam
- coordinate
- included angle
- 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 32
- 230000003247 decreasing effect Effects 0.000 claims 1
- 238000005259 measurement Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/16—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using electromagnetic waves other than radio waves
Landscapes
- Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本发明涉及一种室内定位系统及控制方法，所述方法包括如下步骤：判断红外接收阵列是否识别到激光发射器发出的第一激光束，若是，则获取接收到第一激光束的红外接收模块对应的第一坐标信息并执行下一步，若否，则重复本步骤；控制激光发射器发出第二激光束，并判断红外接收阵列是否识别到激光发射器发出的第二激光束，若是，则获取接收到第二激光束的红外接收模块对应的第二坐标信息并执行下一步，若否，则重复本步骤；根据第一坐标信息、第二坐标信息及可调夹角θ，利用预设公式计算获得所述激光发射器对应位置的空间坐标；本发明定位系统采用红外接收模块，成本较低，定位精度较高，可快速获取室内设置的机械臂及待抓取物体的空间坐标。
Description
技术领域
本发明涉室内定位技术领域，尤其涉及一种室内定位系统及控制方法。
背景技术
机器人在室内移动，机械臂抓取物件等控制操作中，使用摄像头、激光定位、UWB定位等成本过高，蓝牙、WIFI、ZigBee等技术‘定位精度3m～10m，不能满足实际精确定位的需求。为解决此类问题现提出一种低成本、低功耗、普及性强等特点的室内定位系统。
发明内容
为了解决上述技术问题，本发明提供一种室内定位系统及控制方法。
本发明解决上述技术问题的技术方案如下：
第一方面，本发明提供了一种室内定位系统控制方法，所述定位系统包括红外接收阵列和激光发射器，所述红外接收阵列包括多个呈阵列设置于待定位房间天花板的红外接收模块，所述激光发射器用于发出垂直于所述天花板的第一激光束，和与第一激光束呈可调夹角θ的第二激光束，所述控制方法包括如下步骤：
S1，控制所述激光发射器发出第一激光束，判断所述红外接收阵列是否识别到所述激光发射器发出的第一激光束，若是，则获取接收到第一激光束的红外接收模块对应的第一坐标信息并执行S2，若否，则重复所述S1；
S2，控制所述激光发射器发出第二激光束，判断所述红外接收阵列是否识别到所述激光发射器发出的第二激光束，若是，则获取接收到第二激光束的红外接收模块对应的第二坐标信息并执行S3，若否，则调节可调夹角θ并重复所述S2；
S3，根据所述第一坐标信息、所述第二坐标信息及所述可调夹角θ，利用预设公式计算获得所述激光发射器对应位置的空间坐标。
优选的，所述S1之前还包括如下步骤：
获取每一所述红外接收模块的身份标识信息；
将每一所述红外接收模块的身份标识信息与对应位置的空间坐标配对并建立红外接收模块坐标数据库。
优选的，所述预设公式为：
式中：(x,y,h)为激光发射器对应位置的空间坐标；x为横坐标、y为纵坐标、h为竖坐标；x1、y1依次为所述第一坐标的横坐标值和纵坐标值，x2、y2依次为所述第二坐标的横坐标值和纵坐标值。
优选的，所述S3中调节可调夹角θ并重复所述S2具体包括如下步骤：
按照预设方法控制所述激光发射器调整所述可调夹角θ；
根据调整后的所述可调夹角θ控制所述激光发射器发出第二激光束，判断所述红外接收阵列是否识别到所述激光发射器发出的第二激光束，若是，则获取接收到第二激光束的红外接收模块对应的第二坐标信息。
优选的，所述预设方法包括，判断所述可调夹角θ是否大于预设角度，若是，则减小所述可调夹角θ，若否，则增大所述可调夹角θ。
第二方面，本发明提供了一种室内定位系统，所述定位系统包括红外接收阵列和激光发射器，所述红外接收阵列包括多个呈阵列设置于待定位房间天花板的红外接收模块，所述激光发射器用于发出垂直于所述天花板的第一激光束，和与第一激光束呈可调夹角θ的第二激光束，所述定位系统还包括：
第一判断模块，用于：执行S1，控制所述激光发射器发出第一激光束，判断所述红外接收阵列是否识别到所述激光发射器发出的第一激光束，若是，则获取接收到第一激光束的红外接收模块对应的第一坐标信息并执行S2，若否，则重复执行所述S1；
第二判断模块，用于：执行S2，控制所述激光发射器发出第二激光束，判断所述红外接收阵列是否识别到所述激光发射器发出的第二激光束，若是，则获取接收到第二激光束的红外接收模块对应的第二坐标信息并执行S3，若否，则调节可调夹角θ并重复所述S2；
坐标计算模块，用于根据所述第一坐标信息、所述第二坐标信息及所述可调夹角θ，利用预设公式计算获得所述激光发射器对应位置的空间坐标。
优选的，所述室内定位系统还包括：
标识信息获取模块，用于获取每一所述红外接收模块的身份标识信息；
数据采集模块，用于将每一所述红外接收模块的身份标识信息与一空间坐标点对应，建立红外接收模块坐标数据库。
进一步，所述预设公式为：
式中：(x,y,h)为激光发射器对应位置的空间坐标；x为横坐标、y为纵坐标、h为竖坐标；x1、y1依次为所述第一坐标的横坐标值和纵坐标值，x2、y2依次为所述第二坐标的横坐标值和纵坐标值。
进一步，所述室内定位系统还包括：更新计算模块，用于执行：
按照预设方法控制所述激光发射器调整所述可调夹角θ；
根据调整后的所述可调夹角θ控制所述激光发射器发出第二激光束，判断所述红外接收阵列是否识别到所述激光发射器发出的第二激光束，若是，则获取接收到第二激光束的红外接收模块对应的第二坐标信息。
进一步，所述室内定位系统还包括：第三判断模块，用于判断所述可调夹角θ是否大于预设角度，若是，则减小所述可调夹角θ，若否，则增大所述可调夹角θ。
本发明的一种室内定位系统及方法的有益效果是：本发明公开的室内定位方法及系统利用激光发射器向红外接收阵列发射垂直于布置于天花板的红外接收阵列的第一激光束和与所述第一激光束呈可调角度可调夹角θ的第二激光束，并获取接收到第一激光束和第二激光束对应红外接收模块的第一坐标信息和第二坐标信息，利用所述第一坐标信息、第二坐标信息及所述可调夹角θ计算所述激光发射器所在位置的空间坐标，可将激光发射器放置至待测空间中的目标位置，即可获取对应空间坐标，定位系统采用红外接收模块，成本较低，定位精度较高。
附图说明
图1为本发明实施例的测量原理示意图；
图2为本发明实施例的一种室内定位方法的第一流程示意图；
图3为本发明实施例的一种室内定位方法的第二流程示意图；
图4为本发明实施例的一种室内定位方法的第三流程示意图。
附图标号：1、红外接收阵列；11、红外接收模块；2、激光发射器；21第一激光头；22、第二激光头；23、角度传感器23；A、第一激光束A；B、第二激光束B。
具体实施方式
以下结合附图对本发明的原理和特征进行描述，所举实例只用于解释本发明，并非用于限定本发明的范围。
第一方面，本发明实施例提供了一种室内定位方法，如图1和图2所示，所述定位系统包括红外接收阵列1和激光发射器2，所述红外接收阵列1包括多个呈阵列设置于待定位房间天花板的红外接收模块11，所述激光发射器2用于发出垂直于所述天花板的第一激光束A，和与第一激光束A呈可调夹角θ的第二激光束B，需要说明的是，所述红外接收阵列1可采用由多个TCRT红外模块拼接而成覆盖待定位空间天花板的红外接收阵列1，所述激光发射器2具有两个激光发射头，即如图1的第一激光头21和第二激光头22，第一激光头21呈垂直于所述红外接收阵列1设置，第一激光头21发出垂直于所述红外接收阵列1的所述第一激光束A，第二激光头22可通过电机驱动相对于第一激光头21在一平面上呈可调夹角θ设置，第二激光头22发出的第二激光束B对应与所述第一激光束A呈可调夹角θ设置，所述第一激光头21和所述第二激光头22及控制所述第二激光头22摆动的电机均与控制器电连接，控制器可分别控制第一激光头21发出第一激光束A，控制第二激光头22发出第二激光束B，控制电机驱动第二激光头22转动以使得所述第一激光束A和所述第二激光束B之间的夹角呈所述可调夹角θ设置。如图2所示，所述控制方法包括如下步骤：
S1、控制所述激光发射器发出第一激光束，判断所述红外接收阵列1是否识别到所述激光发射器2发出的第一激光束A，若是，则获取接收到第一激光束A的红外接收模块11对应的第一坐标信息并执行下一步，若否，则重复本步骤。
本步骤中，需要说明的是，所述红外接收阵列1中的信号输出端均与控制器电连接，控制器控制第一激光头21发出第一激光束A，当红外接收阵列1接收到激光照射时，向控制器发出对应信号，所述控制器可实时遍历各所述红外接收模块11对应的输入端口，当识别到对应的输出信号，例如高低电平信号，即可判断所述红外接收阵列1接收到第一激光束A的照射。所述第一坐标信息可通过预先在控制器中存储各个红外接收模块11及对应的坐标形成待查数据库，再判断是哪个端口输入的接收到第一激光束A照射信号，并在待查数据库中查询对应的坐标作为所述第一坐标信息。
S2、控制所述激光发射器发出第二激光束，判断所述红外接收阵列是否识别到所述激光发射器发出的第二激光束，若是，则获取接收到第二激光束的红外接收模块对应的第二坐标信息并执行S3，若否，则调节可调夹角并重复所述S2；
本步骤中，控制器控制激光发射器2的第二激光头22发出第二激光束B，控制器遍历各所述红外接收模块11对应的输入端口，当识别到除第一激光头21发出的第一激光束A照射所述红外接收模块11的输入口外的第二个输入信号时，可判断对应端口的红外接收模块11接收到第二激光束B的照射。所述第二坐标信息可通过预先在控制器中存储各个红外接收模块11及对应的坐标形成待查数据库，再将前面判断出的接收到第二激光束B照射的红外接收模块11的输出端口在待查数据库中查询对应的坐标作为所述第二坐标信息。
S3、根据所述第一坐标信息、所述第二坐标信息及所述可调夹角，利用预设公式计算获得所述激光发射器对应位置的空间坐标。
需要说明的是所述可调夹角可通过设置在第一激光头21和第二激光头22之间的角度传感器23测得。
本室内定位系统及方法的有益效果是：本发明公开的室内定位方法及系统利用激光发射器2向红外接收阵列1发射垂直于布置于天花板的红外接收阵列1的第一激光束A和与所述第一激光束A呈可调角度可调夹角θ的第二激光束B，并获取接收到第一激光束A和第二激光束B对应红外接收模块11的第一坐标信息和第二坐标信息，利用所述第一坐标信息、第二坐标信息及所述可调夹角θ计算所述激光发射器2所在位置的空间坐标，可将激光发射器2放置至待测空间中的目标位置，即可获取对应空间坐标，定位系统采用红外接收模块11，成本较低，定位精度较高。
具体地，如图1和图3所示，在本发明具体地实施例中，所述判断所述红外接收阵列1是否识别到所述激光发射器2发出的第一激光束A，若是，则获取接收到第一激光束A的红外接收模块11对应的第一坐标信息并执行下一步，若否，则本步骤之前还包括如下步骤：
S01、获取每一所述红外接收模块的身份标识信息。
本步骤中，所述身份标识信息可以为每一所述红外接收模块11输出接口与对应控制器的连接的端口序号。
S02、将每一所述红外接收模块的身份标识信息与对应位置的空间坐标配对并建立红外接收模块坐标数据库。
需要说明的是，本步骤中，所述空间坐标可以为预先安装红外接收阵列1时记录的每一红外接收模块11所在空间位置坐标，所述坐标数据库中的每一组数据包括一红外接收模块11与控制器连接的接线端口编号及对应的空间坐标。
本具体地实施例，通过预先建立红外接收模块11的坐标数据库，可便于红外接收阵列1在接收到第一激光束A和第二激光束B后向控制器输出对应的信号，控制器根据接收到对应信号的端口编号在预先建立的红外接收模块11坐标数据库中查询即可得到接收到第一激光束A和第二激光束B照射的红外接收模块11的坐标位置。
具体地的，所述预设公式为：
式中：(x,y,h)为激光发射器对应位置的空间坐标；x为横坐标、y为纵坐标、h为竖坐标；x1、y1依次为所述第一坐标的横坐标值和纵坐标值，x2、y2依次为所述第二坐标的横坐标值和纵坐标值。
需要说明的是，由于待定位激光器发出的第一激光束A为垂直于所述红外接收阵列1的激光束，所以待定位激光发射器2的x坐标和y坐标与接收到第一激光束A照射的红外接收模块11对应位置的x坐标和y坐标相同，式中：
计算出了红外接收阵列1接收到第一激光束A照射的红外接收模块11对应的坐标点和接收到第二激光束B照射的红外接收模块11坐标点之间的距离，式中：
两坐标点之间的距离通过三角函数关系得出待测激光发射器2距离红外接收阵列1的距离，式中“-”表示激光发射器2位于红外接收模块11的下侧。
具体地，如图1和图4所示，所述S3中调节可调夹角θ并重复所述S2具体包括如下步骤：
S31，按照预设方法控制所述激光发射器调整所述可调夹角θ；
S32，根据调整后的所述可调夹角θ控制所述激光发射器发出第二激光束，判断所述红外接收阵列是否识别到所述激光发射器发出的第二激光束，若是，则获取接收到第二激光束的红外接收模块对应的第二坐标信息。
本步骤中需要说明的是，所述可调夹角θ可通过控制器控制激光发射器2的驱动电机驱动第二激光头22转动改变第一激光头21和第二激光头22之间的夹角获得。
本步骤中，在接收到第二激光束B调整后照射到红外接收阵列1时，获取更新的第二激光束B照射位置对应的身份标识信息，可为输入控制器的输入接口标号，再在预设的的红外接收模块11坐标数据库中查询即可的第二坐标更新值，在利用预设公式即可计算更新后的待测激光发射器2的坐标，当然还可以多次重复操作，取多次测量的平均值，来减小测量的随机误差。
具体地，所述预设规则包括，判断所述可调夹角θ是否大于预设角度，若是，则减小所述可调夹角θ，若否，则增大所述可调夹角θ。
需要说明的是，所述预设规则的预设角度可为30至60°，能较好地避免cotθ的数值过大或过小导致公式计算的不准确。
第二方面，本发明提供了一种室内定位系统，所述定位系统包括红外接收阵列1和激光发射器2，所述红外接收阵列1包括多个呈阵列设置于待定位房间天花板的红外接收模块11，所述激光发射器2用于发出垂直于所述天花板的第一激光束A，和与第一激光束A呈可调夹角的第二激光束B，所述定位系统还包括：
第一判断模块，用于执行S1：控制所述激光发射器发出第一激光束，判断所述红外接收阵列是否识别到所述激光发射器发出的第一激光束，若是，则获取接收到第一激光束的红外接收模块对应的第一坐标信息并执行S2，若否，则重复所述S1。
需要说明的是，所述红外接收阵列1中的信号输出端均与控制器电连接，控制器控制第一激光头21发出第一激光束A，当红外接收阵列1接收到激光照射时，向控制器发出对应信号，所述控制器可实时遍历各所述红外接收模块11对应的输入端口，当识别到对应的输出信号，例如高低电平信号，即可判断所述红外接收阵列1接收到第一激光束A的照射。所述第一坐标信息可通过预先在控制器中存储各个红外接收模块11及对应的坐标形成待查数据库，再判断是哪个端口输入的接收到第一激光束A照射信号，并在待查数据库中查询对应的坐标作为所述第一坐标信息。
第二判断模块，用于控制所述激光发射器发出第二激光束，判断所述红外接收阵列是否识别到所述激光发射器发出的第二激光束，若是，则获取接收到第二激光束的红外接收模块对应的第二坐标信息并执行S3，若否，则调节可调夹角θ并重复所述S2。
需要说明的是，控制器控制激光发射器2的第二激光头22发出第二激光束B，控制器遍历各所述红外接收模块11对应的输入端口，当识别到除第一激光头21发出的第一激光束A照射所述红外接收模块11的输入口外的第二个输入信号时，可判断对应端口的红外接收模块11接收到第二激光束B的照射。所述第二坐标信息可通过预先在控制器中存储各个红外接收模块11及对应的坐标形成待查数据库，再将前面判断出的接收到第二激光束B照射的红外接收模块11的输出端口在待查数据库中查询对应的坐标作为所述第二坐标信息。
坐标计算模块，用于根据所述第一坐标信息、所述第二坐标信息及所述可调夹角，利用预设公式计算获得所述激光发射器对应位置的空间坐标。。
具体地，所述定位系统还包括：
标识信息获取模块，用于获取每一所述红外接收模块11的身份标识信息；
需要说明的是，所述身份标识信息可以为每一所述红外接收模块11输出接口与对应控制器的连接的端口序号。
数据采集模块，用于将每一所述红外接收模块11的身份标识信息与一空间坐标点对应，建立红外接收模块11坐标数据库。
需要说明的是，所述空间坐标可以为预先安装红外接收阵列1时记录的每一红外接收模块11所在空间位置坐标，所述坐标数据库中的每一组数据包括一红外接收模块11与控制器连接的接线端口编号及对应的空间坐标。
本具体地实施例，通过标识信息获取模块预先建立红外接收模块11的坐标数据库，可便于红外接收阵列1在接收到第一激光束A和第二激光束B后向控制器输出对应的信号，控制器根据接收到对应信号的端口编号在预先建立的红外接收模块11坐标数据库中查询即可得到接收到第一激光束A和第二激光束B照射的红外接收模块11的坐标位置。
所述预设公式为：
式中：(x,y,h)为激光发射器对应位置的空间坐标；x为横坐标、y为纵坐标、h为竖坐标；x1、y1依次为所述第一坐标的横坐标值和纵坐标值，x2、y2依次为所述第二坐标的横坐标值和纵坐标值。
需要说明的是，由于待定位激光器发出的第一激光束A为垂直于所述红外接收阵列1的激光束，所以待定位激光发射器2的x坐标和y坐标与接收到第一激光束A照射的红外接收模块11对应位置的x坐标和y坐标相同，式中：
计算出了红外接收阵列1接收到第一激光束A照射的红外接收模块11对应的坐标点和接收到第二激光束B照射的红外接收模块11坐标点之间的距离，式中：
两坐标点之间的距离通过三角函数关系得出待测激光发射器2距离红外接收阵列1的距离，式中“-”表示激光发射器2位于红外接收模块11的下侧。
具体地，所述定位系统还包括：更新计算模块，用于：执行如下步骤：
S31，按照预设方法控制所述激光发射器调整所述可调夹角θ；
S32，根据调整后的所述可调夹角θ控制所述激光发射器发出第二激光束，判断所述红外接收阵列是否识别到所述激光发射器发出的第二激光束，若是，则获取接收到第二激光束的红外接收模块对应的第二坐标信息。
需要说明的是，本具体地实施例中，在接收到第二激光束B调整后照射到红外接收阵列1时，获取更新的第二激光束B照射位置对应的身份标识信息，可为输入控制器的输入接口标号，再在预设的的红外接收模块11坐标数据库中查询即可的第二坐标更新值，在利用预设公式即可计算更新后的待测激光器的坐标，当然还可以多次重复操作，取多次测量的平均值，来减小测量的随机误差。
具体地，所述定位系统还包括：第三判断模块，用于判断所述可调夹角是否大于预设角度，若是，则减小所述可调夹角，若否，则增大所述可调夹角。
需要说明的是，所述预设规则的预设角度可为30至60°，能较好地避免cotθ的数值过大或过小导致公式计算的不准确。
本发明的一种室内定位系统及方法的有益效果是：本发明实施例提供的室内定位方法及系统利用激光发射器2向红外接收阵列1发射垂直于布置于天花板的红外接收阵列1的第一激光束A和与所述第一激光束A呈可调角度可调夹角θ的第二激光束B，并获取接收到第一激光束A和第二激光束B对应红外接收模块11的第一坐标信息和第二坐标信息，利用所述第一坐标信息、第二坐标信息及所述可调夹角θ计算所述激光发射器2所在位置的空间坐标，可将激光发射器2放置至待测空间中的目标位置，即可获取对应空间坐标，定位系统采用红外接收模块11，成本较低，定位精度较高。
以上所述仅为本发明的较佳实施例，并不用以限制本发明，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。
Claims (8)
1.一种室内定位系统控制方法，其特征在于，所述定位系统包括红外接收阵列和激光发射器，所述红外接收阵列包括多个呈阵列设置于待定位房间天花板的红外接收模块，所述激光发射器用于发出垂直于所述天花板的第一激光束，和与第一激光束呈可调夹角θ的第二激光束；
其中，所述激光发射器具有两个激光发射头，即第一激光头和第二激光头，第一激光头呈垂直于所述红外接收阵列设置，第一激光头发出垂直于所述红外接收阵列的所述第一激光束，第二激光头通过电机驱动相对于第一激光头在一平面上呈可调夹角θ设置，第二激光头发出的第二激光束对应与所述第一激光束呈可调夹角θ设置；
所述控制方法包括如下步骤：
S1，控制所述激光发射器发出第一激光束，判断所述红外接收阵列是否识别到所述激光发射器发出的第一激光束，若是，则获取接收到第一激光束的红外接收模块对应的第一坐标信息并执行S2，若否，则重复所述S1；
S2，控制所述激光发射器发出第二激光束，判断所述红外接收阵列是否识别到所述激光发射器发出的第二激光束，若是，则获取接收到第二激光束的红外接收模块对应的第二坐标信息并执行S3，若否，则调节可调夹角θ并重复所述S2；
S3，根据所述第一坐标信息、所述第二坐标信息及所述可调夹角θ，利用预设公式计算获得所述激光发射器对应位置的空间坐标；
所述预设公式为：
式中：(x,y,h)为激光发射器对应位置的空间坐标；x为横坐标、y为纵坐标、h为竖坐标；x1、y1依次为所述第一坐标的横坐标值和纵坐标值，x2、y2依次为所述第二坐标的横坐标值和纵坐标值。
2.根据权利要求1所述的室内定位系统控制方法，其特征在于，所述S1之前还包括如下步骤：
获取每一所述红外接收模块的身份标识信息；
将每一所述红外接收模块的身份标识信息与对应位置的空间坐标配对并建立红外接收模块坐标数据库。
3.根据权利要求1所述的室内定位系统控制方法，其特征在于，所述S2中调节可调夹角θ并重复所述S2具体包括如下步骤：
按照预设方法控制所述激光发射器调整所述可调夹角θ；
根据调整后的所述可调夹角θ控制所述激光发射器发出第二激光束，判断所述红外接收阵列是否识别到所述激光发射器发出的第二激光束，若是，则获取接收到第二激光束的红外接收模块对应的第二坐标信息。
4.根据权利要求3所述的室内定位系统控制方法，其特征在于，所述预设方法包括，判断所述可调夹角θ是否大于预设角度，若是，则减小所述可调夹角θ，若否，则增大所述可调夹角θ。
5.一种室内定位系统，其特征在于，所述定位系统包括红外接收阵列和激光发射器，所述红外接收阵列包括多个呈阵列设置于待定位房间天花板的红外接收模块，所述激光发射器用于发出垂直于所述天花板的第一激光束，和与第一激光束呈可调夹角θ的第二激光束；
所述激光发射器具有两个激光发射头，即第一激光头和第二激光头，第一激光头呈垂直于所述红外接收阵列设置，第一激光头发出垂直于所述红外接收阵列的所述第一激光束，第二激光头通过电机驱动相对于第一激光头在一平面上呈可调夹角θ设置，第二激光头发出的第二激光束对应与所述第一激光束呈可调夹角θ设置；
所述定位系统还包括：
第一判断模块，用于：执行S1，控制所述激光发射器发出第一激光束，判断所述红外接收阵列是否识别到所述激光发射器发出的第一激光束，若是，则获取接收到第一激光束的红外接收模块对应的第一坐标信息并执行S2，若否，则重复执行所述S1；
第二判断模块，用于：执行S2，控制所述激光发射器发出第二激光束，判断所述红外接收阵列是否识别到所述激光发射器发出的第二激光束，若是，则获取接收到第二激光束的红外接收模块对应的第二坐标信息并执行S3，若否，则调节可调夹角θ并重复所述S2；
坐标计算模块，用于根据所述第一坐标信息、所述第二坐标信息及所述可调夹角θ，利用预设公式计算获得所述激光发射器对应位置的空间坐标；
所述预设公式为：
式中：(x,y,h)为激光发射器对应位置的空间坐标；x为横坐标、y为纵坐标、h为竖坐标；x1、y1依次为所述第一坐标的横坐标值和纵坐标值，x2、y2依次为所述第二坐标的横坐标值和纵坐标值。
6.根据权利要求5所述的室内定位系统，其特征在于，还包括：
标识信息获取模块，用于获取每一所述红外接收模块的身份标识信息；
数据采集模块，用于将每一所述红外接收模块的身份标识信息与一空间坐标点对应，建立红外接收模块坐标数据库。
7.根据权利要求5所述的室内定位系统，其特征在于，还包括更新计算模块，用于执行：
按照预设方法控制所述激光发射器调整所述可调夹角θ；
根据调整后的所述可调夹角θ控制所述激光发射器发出第二激光束，判断所述红外接收阵列是否识别到所述激光发射器发出的第二激光束，若是，则获取接收到第二激光束的红外接收模块对应的第二坐标信息。
8.根据权利要求7所述的室内定位系统，其特征在于，还包括第三判断模块，用于判断所述可调夹角θ是否大于预设角度，若是，则减小所述可调夹角θ，若否，则增大所述可调夹角θ。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911139965.8A CN110865335B (zh) | 2019-11-20 | 2019-11-20 | 一种室内定位系统及控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911139965.8A CN110865335B (zh) | 2019-11-20 | 2019-11-20 | 一种室内定位系统及控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110865335A CN110865335A (zh) | 2020-03-06 |
| CN110865335B true CN110865335B (zh) | 2021-12-28 |
Family
ID=69655588
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201911139965.8A Expired - Fee Related CN110865335B (zh) | 2019-11-20 | 2019-11-20 | 一种室内定位系统及控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110865335B (zh) |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2012089420A1 (de) * | 2010-12-28 | 2012-07-05 | Robert Bosch Gmbh | Handgehaltenes laserentfernungsmessgerät |
| CN107300685A (zh) * | 2017-06-30 | 2017-10-27 | 电子科技大学 | 一种用激光对目标物进行定位的装置及方法 |
Family Cites Families (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102818568B (zh) * | 2012-08-24 | 2016-12-21 | 中国科学院深圳先进技术研究院 | 室内机器人的定位与导航系统及方法 |
| US10643351B2 (en) * | 2013-03-20 | 2020-05-05 | Trimble Inc. | Indoor navigation via multi beam laser projection |
| TWI548891B (zh) * | 2015-01-12 | 2016-09-11 | 金寶電子工業股份有限公司 | 掃地機定位系統及其定位方法 |
| CN106291468B (zh) * | 2016-10-09 | 2018-08-03 | 无锡职业技术学院 | 一种可远程监控的超声波室内快速定位系统及其定位方法 |
| CN108181610B (zh) * | 2017-12-22 | 2021-11-19 | 鲁东大学 | 室内机器人定位方法和系统 |
| TWI665461B (zh) * | 2018-05-04 | 2019-07-11 | 財團法人工業技術研究院 | 雷射定位系統及使用此系統之位置量測方法 |
| CN109099842A (zh) * | 2018-09-17 | 2018-12-28 | 昆明简酷科技有限公司 | 基于光栅矩阵技术的室内定位和行迹跟踪系统 |
-
2019
- 2019-11-20 CN CN201911139965.8A patent/CN110865335B/zh not_active Expired - Fee Related
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2012089420A1 (de) * | 2010-12-28 | 2012-07-05 | Robert Bosch Gmbh | Handgehaltenes laserentfernungsmessgerät |
| CN107300685A (zh) * | 2017-06-30 | 2017-10-27 | 电子科技大学 | 一种用激光对目标物进行定位的装置及方法 |
Non-Patent Citations (2)
| Title |
|---|
| "Integrated Indoor Navigation System for Ground Vehicles With Automatic 3-D Alignment and Position Initialization";Mohamed M. Atia et al.;《IEEE Transactions on Vehicular Technology》;20150130;第64卷(第4期);1279-1292 * |
| "基于激光传感器的移动机器人定位和地图构建研究";刘丽雯;《中国优秀博硕士学位论文全文数据库(硕士) 信息科技辑》;20091015(第10期);25-34 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN110865335A (zh) | 2020-03-06 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN105116378B (zh) | 一种无线、超声波复合定位系统及其定位方法 | |
| US8301325B2 (en) | System and method for autonomous vehicle localization | |
| US7725287B2 (en) | System and method for using structured shapes to increase laser scanner accuracy | |
| US9862097B2 (en) | Industrial robot system having sensor assembly | |
| US11971487B2 (en) | Feature data structure, control device, storage device, control method, program and storage medium | |
| US10744645B2 (en) | Measurement system | |
| CN201653373U (zh) | 三轴非接触式影像测量系统 | |
| US10165172B2 (en) | Camera system and control method therefor, and electronic device and control program therefor | |
| CN102980551A (zh) | 一种基于激光超声融合扫描的无线定位平整度检测系统 | |
| CN104102222A (zh) | 一种agv精确定位的方法 | |
| US10935968B2 (en) | Robot, robot system, and method for setting coordinate system of robot | |
| CN106338290B (zh) | 一种机器人自主充电的导航系统及方法 | |
| KR100616774B1 (ko) | 무선통신을 이용한 이동체의 위치인식시스템 및위치인식방법 | |
| JPWO2018230517A1 (ja) | 作業システム | |
| AU2016363764A1 (en) | Monitoring and/or registering a position of a tool in an elevator shaft | |
| CN110471430B (zh) | 一种agv局部高精度定位导航装置 | |
| CN110865335B (zh) | 一种室内定位系统及控制方法 | |
| CN108919297A (zh) | 一种无人机室内定位系统及方法 | |
| KR101921113B1 (ko) | 탐지용 하이브리드 가시광 ｒｆｉｄ 태그 및 이에 사용되는 로봇시스템 | |
| CN110186451A (zh) | 适用于仓储系统的导航系统与物料输送载具的导航方法 | |
| CN114532917B (zh) | 扫地机回充座定位方法、装置、设备及介质 | |
| US20180229374A1 (en) | Detection of engagement of robot with object | |
| EP3842820B1 (en) | Power positioning method and power positioning device | |
| CN110703771B (zh) | 基于视觉的多设备之间的控制系统 | |
| CN110296680B (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 | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20211228 |
|
| CF01 | Termination of patent right due to non-payment of annual fee |