[发明专利]一种叶片机器人砂带磨削加工力控制方法

摘要

本发明公开了一种叶片机器人砂带磨削加工力控制方法，包括如下步骤：电压信号的调制与处理；对转化后的力进行补偿；力控制策略。其中，电压信号的调制与处理包括：获取传感器六个通道的电压信号；对获取的电压信号进行软件滤波；将滤波后的电压信号转化为力信号。对转化后的力进行补偿包括：传感器自身的零点漂移补偿和机器人末端负载的重力补偿。力控制策略包括：力位混合控制和PI/PD控制。本发明的叶片机器人砂带磨削加工力控制方法不仅能够提高磨削加工的效率，克服人工磨削加工一致性较差的情形，还能够实现恒力磨削加工，使其表面材料去除量较为均匀一致，在提高加工的精度和表面质量的同时，又提高了叶片的表面一致性。

主权项

1.一种叶片机器人砂带磨削加工力控制方法，其特征在于，包括如下步骤：S101：将传感器获取的电压信号转化为力信号，并将之处理与磨削加工过程力相对应，并且实时监控力的变化；S102：对监控到的力进行控制和处理，使其磨削力恒定，满足恒力磨削加工的要求，包括如下步骤：S201：判断实际的磨削力与理论的参考力的大小，IF实际力>参考力，则转入步骤S202；S202：机器人沿其Z轴负方向进给运动；S203：IF实际力<＝参考力，则转入步骤S204；S204：机器人沿其Z轴正方向进给运动；S205：根据实际力来计算对应的理论机器人位置信息；S206：将机器人磨削加工系数刚度换算成机器人能够识别的位置信息，完成相应的位置运动；S207：通过调整，完成恒力磨削加工力控制；S103：获取传感器六个通道的电压信号；S104：对获取的电压信号进行调制处理；S105：将处理的电压信号转化为力信号，从而间接感知力的变化；S106：对其进行零漂补偿，减少传感器自身引入误差；S107：对传感器末端负载进行重力补偿；S108：将补偿后的力转化到基坐标系下，再转化到工具坐标系下，从而直接对应加工中的过程力；S109：力/位混合控制定义两个互补的、相互正交的空间，实现对力和位置的同时控制；S110：PI/PD控制，消除较大的力偏差，得到更快的系统响应度，从而获得更加理想的输出力，实现叶片机器人砂带磨削加工力控制；所述力/位混合控制和PI/PD控制应用在笛卡尔空间坐标系中时，其控制模型为：其中，F_D是输入力，X_D是笛卡尔空间期望位移，X_f是力控制后输出的位移，X_p是位置控制后输出的位移，X_c为通过力控制后得到的位置量，F_e是输出力，X_e是综合的位移，s是相关系数，k_pp和k_pd是采用PD位置控制的相关系数，k_fp和k_fi是PI力控制的相关系数。