专利详情

专利名称	基于色标块的视觉实时测量方法
申请号	CN201010592895.4	专利类型	发明专利
公开（公告）号	CN102128617A	公开（授权）日	2011.07.20
申请（专利权）人	中国科学院自动化研究所	发明（设计）人	徐德;谭民;陈国栋;任艳青;张正涛;杨平
主分类号	G01C11/00(2006.01)I	IPC主分类号	G01C11/00(2006.01)I;G01C11/04(2006.01)I
专利有效期	基于色标块的视觉实时测量方法至基于色标块的视觉实时测量方法	法律状态	实质审查的生效
说明书摘要	本发明是基于色标块的视觉实时测量方法，步骤S1：在机器人的背部上方设有已知尺寸的色标块；步骤S2：以单摄像机采集色标块的色标图像；步骤S3：跟踪色标块的中心点、长边中点和短边中点确定色标块图像区域；步骤S4：对色标图像按照设定的间隔和方向扫描处理获得具有亚像素精度的边缘点；步骤S5：将亚像素精度的色标块边缘点经最小二乘拟合获得四条边缘直线；步骤S6：求四条边缘直线的交点获得四个顶点的图像坐标；步骤S7：计算色标块新的中心点、新的一条长边中点和新的一条短边中点；步骤S8：利用n点透视算法求取机器人位姿；步骤S9：利用正交迭代算法对机器人位姿进行优化，得到机器人的姿态矩阵正交的位姿。