一种基于移动设备的定位装置及其定位方法
【技术领域】
[0001] 本发明涉及图像定位技术领域，尤其是指一种基于移动设备的定位装置及其定位 方法。
【背景技术】
[0002] 目前，移动设备的定位方法分为相对定位方法和绝对定位方法。相对定位方法 是指依靠里程计和惯性系统实现自主定位。绝对定位方法主要靠声呐、激光、视觉传感 器等，给出移动机器人在全局参考坐标系中的绝对位置，但是，仅仅靠其自身传感器感 知能力来实现移动机器人的全局定位需要花费较大时间和计算代价。中国专利公开号 CN202889634U，公开日2013年4月17日，名称为"移动设备定位装置"的实用新型专利中 公开了一种移动设备定位装置，包括移动设备、嵌入式基站、外网服务器以及数据库，其中， 该移动设备包括移动设备控制模块以及与该移动设备控制模块相连接的移动设备蓝牙模 块，所述移动设备控制模块用于控制所述移动设备蓝牙模块，并用于与所述外网服务器相 通讯，所述移动设备蓝牙模块用于发送所述移动设备的移动设备信息；该嵌入式基站包括 嵌入式蓝牙模组、数据处理单元以及网络接口单元；所述外网服务器包括服务器监控单元 和服务器处理单元，并与所述数据库相连接。不足之处在于，该实用新型仍要靠移动设备本 身进行定位，使用上仍有局限。
【发明内容】
[0003] 本发明的目的是克服现有技术中移动设备的定位需要靠移动设备本身进行定位， 定位的时间较长、计算方法较为繁琐的缺陷，提供一种基于移动设备的定位装置及其定位 方法，通过该定位装置及其定位方法可以辅助移动设备进行定位，定位时间较短、计算方法 简单。
[0004] 本发明的目的是通过下述技术方案予以实现：
[0005] -种基于移动设备的定位装置，包括移动设备、若干个固定视频捕捉设备、中心控 制服务器、至少两个微动开关和与微动开关一一对应且设置在微动开关附近的摄像头，微 动开关和摄像头均设置在移动设备外表面上，若干个固定视频捕捉设备通过局域网与中心 控制服务器相连接，中心控制服务器通过无线网与移动设备相连接且中心控制服务器通过 无线网与移动设备上的微动开关和摄像头相连接。若干个固定视频捕捉设备设置在场景的 角落捕捉场景内的移动设备的位置，多个固定设备共同定位能使定位更加精确。
[0006] 由于移动设备的工作环境复杂，而固定视频捕捉设备数量有限，有时候固定视频 捕捉设备不能检测到移动设备或者检测误差较大，此时移动设备如果触碰到周围环境物体 则使微动开关闭合，同时与此微动开关匹配的摄像头开启用于检测移动设备周围的环境， 便于移动设备精确的定位以及快速脱离复杂的环境。
[0007] 作为一种优选方案，定位装置还包括以太网HUB，以太网HUB通过网线与若干个固 定视频捕捉设备相连接，以太网HUB设有无线网接入端口，无线网接入端口通过无线网与 移动设备以及移动设备上的微动开关和摄像头相连接，以太网HUB还通过网线与中心控制 服务器相连接。
[0008] 固定视频捕捉设备通过网线与以太网HUB连接成本较低，而移动设备由于移动限 制必须通过无线与以太网HUB连接。
[0009] 作为一种优选方案，微动开关和摄像头的数量均为3个，3个微动开关处于同一个 平面且3个微动开关两两之间距离相等。
[0010] -种基于移动设备的定位装置的定位方法，包括以下步骤：
[0011] 步骤1，移动设备开始工作，中心控制服务器收到移动设备工作信号，然后中心控 制服务器控制固定视频捕捉设备进行工作；
[0012] 步骤2,固定视频捕捉设备通过投影法彩色目标快速检测对移动设备进行快速标 定；
[0013] 具体步骤为：固定视频捕捉设备识别出移动设备后，通过二值图像进行相应的特 征匹配确定移动设备的中心点坐标。定义一幅二值图像由MXN个像素组成，其中N是行 数，Μ是列数。每个像素都对应确定的图像坐标（i，j)，以及灰度值f(i，j)，移动设备灰度 为1，背景灰度为〇。投影法得出移动设备高度以及移动设备宽度分别为：
[0014]
[0015] 移动设备的中心点在水平方向和垂直方向的坐标值为：
[0016；
[0017] 其中，K，Η分别是水平投影和垂直投影钟非零元素的个数，K彡M，Η彡M。
[0018] 步骤3,装置通过Tsai氏标定法和多项式拟合的全局定位算法对固定视频捕捉设 备进行标定；
[0019] 采用Tsai共面法，获取固定视频捕捉设备内外参数，得到图像坐标到全局坐标的 转换。考虑到畸变补偿的复杂性，本文采用多项式拟合方法对标定后的固定视频捕捉设备 定位数据进行再次处理，忽略固定视频捕捉设备畸变参数。
[0020] 设（X，Y)为空间平面中的点（移动设备运动过程中移动设备圆柱标签与地面平行 的平面），通过固定视频捕捉设备标定后得到的对应点的平面坐标测量值为（X，y)，与真实 值（X，Y)之间的多项式关系为：
[0021]
^ 1 ..3 一' Ο.-忒 Ο -Iv/ S
[0022] 其中：k为多项式的次数，ai，a2，…，as;bpb2，…，匕为多项式的待定系数。
[0023] 由式⑶得到：
[0024]
[0025] 在固定视频捕捉设备拍摄区域均匀采样η个点，真实的世界坐标依次为（Xyt)， 对应测量得到的世界坐标为（Xl，yi)，i=l，2, "·，η。设
[0026]
[0027]
[0028]
[0029] 由式⑷得到以下方程：
[0030]X=xyXa,Y=xyXb (5)
[0031] 根据式（5)，采用最小二乘法得到a，b向量的值，从而得到校正后的定位坐标。
[0032] 步骤4,装置采用多视觉节点对移动设备进行协同定位。
[0033] 以固定视频捕捉设备图像中心为中心位置将图像划分为3个区域：最佳区域、可 信区域以及偏离区域，检测到在最佳区域和可信区域的移动设备后，固定视频捕捉设备发 送视觉定位信息至中心控制服务器，中心控制服务器接收到定位信息后，将定位信息融合； 检测到在偏离区域的移动设备后，固定视频捕捉设备发送偏离区域定位信息，中心控制服 务器提取偏离视野定位信息后，将定位信息融合。有与单个固定视频捕捉设备视野有限，当 移动设备原理固定视频捕捉设备图像中心是，固定视频捕捉设备标定算法会产生较大的误 差，所以处于偏离区域的移动设备的定位信息仅供参考，当有多个固定视频捕捉设备时，移 动设备处于偏离区域的固定视频捕捉设备的定位信息将不予采纳。
[0034] 作为一种优选方案，当固定视频捕捉设备不能捕捉移动设备或固定视频捕捉设备 捕捉移动设备误差较大时，中心控制服务器控制激活微动开关和摄像头，当微动开关受到 外力触碰闭合时，与此微动开关匹配的摄像头开启进行摄像工作。
[0035] 本发明的有益效果是，基于移动设备的定位装置及其定位方法能对移动设备进行 快速精确定位，定位效率大大提高。且本