一种基于视觉测量及标定的AGV自动调姿定位方法技术

本发明专利技术公开了一种基于视觉测量及标定的AGV自动调姿定位方法，包括：(1)根据AGV自动调姿系统中的工业CCD相机、标定板、位移传感器、激光跟踪仪以及伸缩柱，对AGV进行标定，得到相机坐标系与AGV坐标系之间的关系

A AGV automatic position adjustment method based on visual measurement and calibration

The invention discloses an automatic adjusting positioning method, visual measurement and calibration based on AGV include: (1) according to the AGV automatic adjusting system of industrial CCD camera, calibration plate, displacement sensor, laser tracker and telescopic column for AGV calibration, the relationship between the camera coordinate and AGV coordinate system

【技术实现步骤摘要】
一种基于视觉测量及标定的AGV自动调姿定位方法
本专利技术属于航空制造领域，尤其涉及一种基于视觉测量及标定的AGV自动调姿定位方法。
技术介绍
如今，AGV被广泛地应用于工业领域。AGV的引入不仅可以减少人工的工作量，还可以很大程度地提升工厂的自动化水平，降低成本以及降低运输过程中损坏工件的可能性，因此AGV系统被广泛使用在物料运输系统中。此外，某些高度自动化的制造过程中，AGV是不可或缺的，尤其适用于在生产线不同装配站位之间转运产品。对AGV系统来说，为了达到自动化运输的目的，如何在某个站位将产品更加平稳快速地转运到AGV上是一个必须要深入考虑的问题。接泊速度和精度严重影响生产效率。对于不同产品、不同工装情况下的站位接泊，对应的AGV接泊方式需要单独设计以使性能最优。
技术实现思路
鉴于上述，本专利技术提出了一种基于视觉测量及标定的AGV自动调姿定位方法，该方法能够将AGV在接泊位置调姿定位到合适位置，达到自动化快速接泊功能。一种基于视觉测量及标定的AGV自动调姿定位方法，包括以下步骤：(1)根据AGV自动调姿系统中的工业CCD相机、标定板、位移传感器、激光跟踪仪以及伸缩柱，对AGV进本文档来自技高网...

【技术保护点】
一种基于视觉测量及标定的AGV自动调姿定位方法，包括以下步骤：(1)根据AGV自动调姿系统中的工业CCD相机、标定板、位移传感器、激光跟踪仪以及伸缩柱，对AGV进行标定，得到相机坐标系与AGV坐标系之间的关系

【技术特征摘要】
1.一种基于视觉测量及标定的AGV自动调姿定位方法，包括以下步骤：(1)根据AGV自动调姿系统中的工业CCD相机、标定板、位移传感器、激光跟踪仪以及伸缩柱，对AGV进行标定，得到相机坐标系与AGV坐标系之间的关系(2)利用关系获得标定板上两个大圆孔中心在AGV坐标系下的当前坐标，根据四个位移传感器与两个大圆孔中心的当前位姿与目标位姿计算得到变换矩阵，进而获得AGV的当前位姿；(3)根据AGV的当前位姿、AGV的目标位姿以及6个支撑定位器在AGV坐标系下的当前坐标规划调姿路径；(4)根据规划得到的调姿路径对AGV进行调姿。2.如权利要求1所述的基于视觉测量及标定的AGV自动调姿定位方法，其特征在于，所述的步骤(1)的具体步骤为：(1-1)将四个标板安装在工位底座基准面上，通过激光跟踪仪测量标定板上的ERS点，调整四个标定板直至处于同一平面且法向沿着基准面法向；(1-2)将AGV车驶入接驳位置，并将AGV固定于地面上的定位窝定位位置处；(1-3)借助激光跟踪仪调整AGV底座姿态，直至接驳移动台能顺利于站位底座与AGV车之间转运；(1-4)通过激光跟踪仪建立AGV坐标系与标定板坐标系的关系(1-5)利用AGV坐标系与标定板坐标系的关系测得标定板中大圆孔中心在AGV坐标系下的坐标；(1-6)驱动4个伸缩柱移动至与其对应的标定板相接触，记录此时的4个位移传感器在AGV坐标系下的读数；(1-7)打开工业CCD相机，微调每个工业CCD相机的位姿，使标定板上的圆孔于相机图像中呈现的图像是圆形而不是椭圆形；(1-8)标定工业CCD相机的内参kx和ky(mm/像素)；即CCD相机的像素与实际距离的对应关系；(1-9)标定相机坐标系与AGV坐标系之间的关系3.如权利要求2所述的基于视觉测量及标定的AGV自动调姿定位方法，其特征在于，所述步骤(1-4)的具体步骤为：(1-4-1)激光跟踪仪测量AGV车身上的ERS点，建立AGV坐标系Base；(1-4-2)激光跟踪仪测量标定板上的ERS点，建立标定板坐标系Plane；(1-4-3)根据坐标系Base与坐标系Plane建立AGV坐标系与标定板坐标系的关系所述的为标定板坐标系在AGV坐标系下的位姿，具体表示为：将标定板上的ERS点在AGV坐标系下的位置坐标与装配现场坐标系下的理论值进行基于SVD的最小二乘匹配计算，即可求得标定板坐标系Plane在AGV坐标系Base下的位姿，即4.如权利要求3所述的基于视觉测量及标定的AGV自动调姿定位方法，其特征在于，用方向余弦矩阵R3×3表示标定板坐标系在AGV坐标系下的姿态，位置用平移向量T3×1表示，则有：设共有n(n>3)个非共面公共观测点，在实际工程中，并不是绝对相等的，存在如下关系：式中，ε为3×1的误差矩阵，为使得ε最小构造目标函数：利用矩阵奇异值分解法，求得旋转矩阵R3×3和平移向量T3×1,得到标定板坐标系和AGV坐标系的关系。5.如权利要求2所述的基于视觉测量及标定的AGV自动调姿定位方法，其特征在于，所述的步骤(1-8)的具体过程为：首先，获取标定板中同一水平线或同一竖直线上的两个圆孔的圆心之间的实际距离；然后，获取图像中同一水平线或同一竖直线上的两个圆孔的圆心之间的像素距离；最后，根据实际距离与像素距离计算得到工业CCD相机的内参kx和ky，单位为mm/像素：其中，Δxi,Δyi分别表示标定板中水平方向和竖直方向上第i组相邻的两个圆孔的圆心之间的实际距离；Δui,Δvi分别表示图像中水平方向和竖直方向上第i组相邻的两个圆孔的圆心之间的像素距离。6.如权利要求2所述的基于视觉测量及标定的AGV自动调姿定位方法，其特征在于，所述的步骤(1-9)的具体过程为：首先，将工业CCD相机自动对焦，使相机坐标系Cemera建立于标定板上，提取所有标定板上圆孔中心在相机坐标系下的坐标；然后，获得从工业CCD相机坐标系Cemera与标定板坐标系Plane之间的关系先将相机坐标系绕标定板的法向方向旋转一个角度α，得到...

【专利技术属性】
技术研发人员：毕运波，李江雄，王青，曲巍崴，柯映林，
申请(专利权)人：浙江大学，
类型：发明
国别省市：浙江,33