梁喜凤, 彭明, 路杰, 秦超. 基于自适应无迹卡尔曼滤波的采摘机械手视觉伺服控制方法[J]. 农业工程学报, 2019, 35(19): 230-237. DOI: 10.11975/j.issn.1002-6819.2019.19.028
    引用本文: 梁喜凤, 彭明, 路杰, 秦超. 基于自适应无迹卡尔曼滤波的采摘机械手视觉伺服控制方法[J]. 农业工程学报, 2019, 35(19): 230-237. DOI: 10.11975/j.issn.1002-6819.2019.19.028
    Liang Xifeng, Peng Ming, Lu Jie, Qin Chao. Servo control method of picking manipulator based on adaptive traceless Kalman filter[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2019, 35(19): 230-237. DOI: 10.11975/j.issn.1002-6819.2019.19.028
    Citation: Liang Xifeng, Peng Ming, Lu Jie, Qin Chao. Servo control method of picking manipulator based on adaptive traceless Kalman filter[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2019, 35(19): 230-237. DOI: 10.11975/j.issn.1002-6819.2019.19.028

    基于自适应无迹卡尔曼滤波的采摘机械手视觉伺服控制方法

    Servo control method of picking manipulator based on adaptive traceless Kalman filter

    • 摘要: 为解决未知统计特性下的系统噪声对图像雅克比矩阵估计精度的影响问题,提高视觉伺服定位精度,在卡尔曼滤波(lalman filter, KF)法以及无迹卡尔曼滤波(unscented kalman filter, UKF)法的基础上,引入自适应噪声统计估计器,提出自适应无迹卡尔曼滤波(adaptive unscented kalman Filter, AUKF)法估计图像雅克比矩阵,并构造了视觉伺服控制系统。仿真试验结果表明,基于自适应无迹卡尔曼滤波法估计图像雅克比矩阵的视觉伺服控制系统的图像特征最大误差值为10.2像素,机械手末端与目标点三维坐标最大误差值为4.19 mm,响应时间为1.2 s。搭建了七自由度采摘机械手视觉伺服试验平台进行采摘试验,试验结果表明,基于AUKF法估计图像雅克比矩阵的视觉伺服系统对静态目标的采摘成功率为90%,对动态目标的采摘成功率为83%,相比于KF法与UKF法,采摘静态目标试验成功率分别提高了17与10个百分点,动态采摘试验成功率分别提高了16%与10%。基于AUKF法估计图像雅克比矩阵的视觉伺服系统对静态与动态目标的采摘平均时间分别为18和22 s,相比于KF法与UKF法,静态采摘用时分别减少了10和6 s,动态采摘用时分别减少了12和8 s。AUKF法与KF法以及UKF法估计的图像雅克比矩阵相比,AUKF法估计的图像雅克比矩阵减小了采摘机械手视觉伺服控制系统过程噪声的干扰,使采摘机械手视觉伺服控制系统过程噪声适应视觉伺服系统的变化,采摘机械手视觉伺服控制系统定位精度更高。

       

      Abstract: Abstract: Image Jacobian matrix is core portion of robot vision servo system. During estimating image Jacobian matrix with traditional methodology of KF (Kalman Filter) and UKF (Unscented Kalman Filter), the system noises of unknown statistical properties is determined according to priori knowledge, which is remained unchanged in system. However, this methodology of dealing system noises would make image Jacobian matrix’s estimation inaccuracy because of time-varying system noises. Based on traditional methodology of KF and UKF, in this paper, we structured propagator of system noises estimation with the difference value of system state predicted value and updated value, and raised Adoption Unscented Kalman Filter to estimate image Jacobian matrix. Two points on the tomato string’s stem, clamping point and picking point, were chosen as feature points in the image feature space. The center of mass of fruit stem was extracted as the holding point. According to the vertical growth characteristics of tomato clusters and the distance between the holding point on the end and the cutting point on the image, a point above the holding point was extracted as the cutting point. Image Jacobian matrix was used to transform information of pixel difference in image feature space to change in pose of end-effector in manipulator motion space. First, results of image feature space localization experiment showed that six image feature errors were smaller and the average image feature error of visual servo system based on AUKF was 4.978 pixes/mm in condition of unknown system noises. Compared with visual servo system based on KF and UKF, average image feature error reduced 54.44% and 24.78%, respectively. Second, three dimensional space positioning experiment between end-effector and target picking point showed that the final distance between end-effector and target picking point was 4.19 mm, reduced by 79.74% and 80.38% compared to methods of KF and UKF. Third, the response time of visual servo control system based on KF method, UKF method and AUKF method to estimate image Jacobian matrix was 2, 1.5 and 1.2 s, respectively. The picking experiment was carried out on the visual servo test platform of the seven-degree-of-freedom picking manipulator. The visual system based on each visual servo control method was tested for 30 times. For the visual servo system based on AUKF method estimation, the success rate of picking the static target was 90%, and the success rate of picking the dynamic target was 83%. Compared with KF methodology and UKF methodology, the success rate of static picking test was increased by 17 and 10 percentage points, respectively, and the success rate of dynamic picking test was increased by 16 and 10 percentage points, respectively. The results showed that the static picking time based on AUKF methodology was the 18 s, compared with the visual servo system based on KF methodology and UKF methodology, the time of static picking was reduced by 35.71% and 25%, respectively. The average dynamic picking time of visual servo system based on AUKF was 22 s and the test time of dynamic picking was reduced by 35.29% and 26.67%, respectively compared with the visual servo system based on KF methodology and UKF methodology. The image Jacobian matrix based on AUKF was suitable for the dynamic picking of tomato clusters, and the accuracy of visual servo control under dynamic condition was lower than that under static condition. Test results suggested that the proposed AUKF method with KF method and the UKF method compared to estimating by image Jacobin matrix, and AUKF method to estimate the image Jacobin matrix, reduced the process of picking robot visual servo control system noise interference, which made the picking robot visual servo control system of processing noise adapted to the change of the visual servo system, resulting in higher positioning precision for picking robot visual servo control system .

       

    /

    返回文章
    返回