[发明专利]主动红外点阵式人工路标及智能体定位系统及方法

摘要

本发明提供一种主动红外点阵式人工路标及智能体定位系统及方法。每个人工路标采用相同尺寸的红外LED灯制作LED灯阵列，通过具有旋转不对称性和唯一性的二维二值矩阵标识其工作状态。在由该人工路标形成的智能体感知定位系统和方法中，通过安装红外窄带滤光片的摄像机感知人工路标；然后从拍摄的图像中提取红外灯中心点的图像坐标；并通过最小最近邻方式聚类，区分出视野中多个人工路标；对每个人工路标点阵进行旋转补偿后采用十字链表法对阵列点编码并匹配出人工路标的编码；再根据编码找到人工路标LED灯的世界坐标；最后结合LED灯的图像坐标和世界坐标求取摄像机相对于人工路标的三维位姿信息，实现智能体的三维定位或位姿测量。

主权项

主动红外点阵式人工路标，其特征在于，包括：红外LED灯阵列、平面电路板和电源；所述红外LED灯阵列由n行n列红外LED灯组成，所述平面电路板提供红外LED灯阵列的机械安装接口和电气接口，其中n为不小于3的整数；红外LED灯阵列中纵向和横向上相邻两红外LED灯之间的间距均相等；所述电源为平面电路板供电；红外LED灯所发出的红外光谱避开可见光波段，且所有红外LED灯均为有源红外LED灯；所述红外LED灯阵列中的每个红外LED灯的尺寸相同；所述红外LED灯阵列中的每个红外LED灯均有一个开关控制其通断，同时通过总开关控制所有红外LED灯的通断。