磨削电主轴位置P。整个控制系统的最终目的是使磨具与工件之间的法向磨削力f保持在设定值或在设定值附近小范围I %波动。
[0037]如图1、2和4所示，力传感器140两端分别固结在力传感器右支座130和力传感器左支座150上，此时测得的接触力为磨削电主轴与工件接触时的法向磨削力。力传感器右支座130和力传感器左支座150具有两条肋板，具有较高的刚度。滚珠丝杠螺母支座70置于力传感器右支座130的矩形槽内，可以保证较高的直线度。
[0038]如图1、2和5所示，轴承座40与电机法兰支座80固定于底部支撑板10上，其中台阶面可以保证两者的同轴度。滚珠丝杠螺母60通过滚珠丝杠螺母支座70与力传感器右支座130相连，位移传感器110紧靠台阶面安装，位移传感器滑动部分也固结在力传感器右支座130上，从而保证位移传感器滑动部分与滚珠丝杠螺母60在移动时具有较高的平行度。
[0039]如图1、2和6所示，磨削电主轴支架160底部设计有凹槽161和凸台162，凹槽161作为定位特征，便于安装力传感器右支座130和力传感器左支座150，并保证良好的直线度；四个凸台162对称分布，加工时平面度较高，从而保证滑块30沿直线导轨20运动时平稳无卡顿。
[0040]如图1、2和7所示，底部支撑板设计有定位法兰11，并通过六个均匀分布的螺纹孔12固定于机器人末端，可实现高精度定位，方便拆卸。
[0041 ]如图1、2和图8所示，主动顺应末端执行器通过底部支撑板10安装于机器人末端，安装方式选择悬挂法，其中机器人末端法兰200，六维力/力矩传感器210，六维力/力矩传感器连接法兰220，快换工具230，快换工具连接法兰240不属于本发明主动顺应末端执行器的结构设计。
[0042]下面将参照图1、4、5和图8来说明主动顺应末端执行器的安装过程。
[0043 ]安装时分为三个模块。首先按照图5所示，将轴承座40、滚珠丝杠50、滚珠丝杠螺母60、滚珠丝杠螺母支座70、电机法兰组件80、弹性联轴器90、伺服电机100等电机驱动部分以及位移传感器110、位移传感器支座120固定于底部支撑板10，将直线导轨20紧靠底部支撑板10台阶面安装，并将滑块置于直线导轨上，并保证良好润滑，从而组成模块I;其次按照图4所示，将力传感器140分别与力传感器右支座130和力传感器左支座150相连，然后将力传感器左支座150安装到磨削电主轴支架160上组成模块2，其中凹槽161作为定位特征保证其与两边导轨的平行度;再次将模块2置于模块I上，通过螺纹孔连接力传感器右支座130与滚珠丝杠螺母支座70，以及磨削电主轴支架160与四个滑块30;最后将磨削电主轴170安装于磨削电主轴支架160并通过螺栓夹紧，将磨具190的刀轴安装于BT30刀柄180中，BT30刀柄180通过磨削电主轴170内部机构锁紧，从而完成末端执行器的装配过程。如图8所示，通过底部支撑板10的定位法兰11与螺纹孔12将末端执行器安装到机器人末端，安装方式选择悬挂法，这种方式机器人具有较好的可达性和可操作性，适用于可调距螺旋桨等大型曲面的磨削加工。
[0044]其中，上述力传感器140优选为S型拉压力传感器，实时检测磨具190所受法向磨削力，输出与所测磨削力线性相关的模拟电压作为末端执行器的控制器输入。
[0045]位移传感器110优选为直线光栅，输出与位置偏差线性相关的上升沿信号数量。
[0046]利用上述主动顺应末端执行器对复杂自由曲面进行机器人磨削的方法包括以下步骤:
[0047]首先由机器人控制系统发出信号使主动顺应末端执行器进入初始状态，末端执行器控制系统设置驱动电机回到零位并保持较小的伺服刚度和阻尼;机器人驱动末端执行器接近工件表面规划路径起始点，力传感器检测法向磨削力信号，如果信号快速上升并超过设定值，控制系统控制伺服电机回退使得力传感器的输出保持在设定值或在设定值附近小范围波动，并通知机器人控制器沿规划轨迹运动；如果接收到机器人控制系统接近完毕信号，力传感器没有检测到接触力信号或者接触力信号小于设定值，则控制系统控制伺服电机前进使得力传感器的输出保持在设定值或在设定值附近小范围波动，并通知机器人控制器沿规划轨迹运动；由于螺旋桨叶片边缘处刚度较小，而叶片中间部位刚度较大，通过位移传感器和力传感器的反馈数据可以得到机器人末端执行器与叶片接触状态下的综合刚度，从而可以更有效的进行接触力控制；当机器人末端执行器与叶片脱离接触时，位移传感器检测滚珠丝杠螺母60的位置，以免其超出滚珠丝杠行程。同时，每次启动前位移传感器都要回到零点，以保证机器人的变换矩阵不变。末端执行器接触力控制和机器人的位置控制是独立的，机器人控制器主要控制机器人本体的运动，完成加工过程中的轨迹规划任务;末端执行器的控制器主要是采集传感器数据，同时快速动态调节伺服电机的伺服刚度和位置，以保持接触力恒定或在设定值附近小范围波动，该小范围的容纳范围在I %，两者通过串行总线通讯，耦合度低，因此便于实施。
[0048]本领域的技术人员容易理解，以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。
【主权项】
1.一种用于可调距螺旋桨机器人磨削的主动顺应末端执行器，其特征在于，该末端执行器包括执行磨具组件、控制组件以及底部支撑组件，其中控制组件容纳于执行磨具组件与底部支撑组件组成的空间内； 其中执行磨具组件包括用于承担执行刀具的磨削电主轴支架(160)，磨削电主轴(170)以及执行磨具(180，190)，所述磨削电主轴支架(160)设置有用于套设所述磨削电主轴(170)的卡箍，其中所述执行磨具(180，190)以所述磨削电主轴(170)为轴执行动作； 其中控制组件包括动力部与传感部，其中动力部包括如下部分:设置于所述底部支撑组件中的底部支撑板(10)上的电机法兰支座(80)，滚珠丝杠(50)左端和右端分别通过轴承座(40)和所述电机法兰支座(80)固定于底部支撑板(10)，所述滚珠丝杠(50)通过滚珠丝杠螺母(60)提供所述磨削电主轴(170)轴向移动自由度，交流伺服电机(100)，通过联轴器(90)与所述滚珠丝杠(50)相连并且通过所述电机法兰支座(80)固定于所述底部支撑板(10)上，所述动力部还包括与所述交流伺服电机(100)相连的控制器； 所述传感部包括如下部分:位移传感器(110)以及力传感器(140)，其中所述位移传感器(110)通过设置于两侧的位移传感器支座(120)与所述底部支撑板(10)相连，活动部分与力传感器右支座(130)相连，所述力传感器(140)的左侧通过力传感器左支座(150)与磨削电主轴支架(160)相连，右侧通过力传感器右支座(130)与设置于所述滚珠丝杠螺母(60)上的滚珠丝杠螺母支座(70)相连，用于检测所述磨具(180，190)所受的法向磨削力； 所述底部支撑组件还包括设置于所述底部支撑板(10)上两侧边沿的直线导轨(20)，所述磨削电主轴支架(160)底部通过滑块(30)沿直线导轨(20)滑动。2.如权利要求1所述的用于可调距螺旋桨机器人磨削的主动顺应末端执行器，其特征在于，所述力传感器(140)为S型拉压力传感器，实时检测所述磨具(180，190)所受法向磨削力，并且输出与所测磨削力线性相关的模拟电压作为所述控制器输入。3.如权利要求1或2所述的用于可调距螺旋桨机器人磨削的主动顺应末端执行器，其特征在于，所述位移传感器(110)为直线光栅，输出与所测位置信息线性相关的信号予所述控制器。4.如权利要求3所述的用于可调距螺旋桨机器人磨削的主动顺应末端执行器，其特征在于，所述控制器接收来自所述机器人、所述力传感器(140)以及所述位移传感器(110)的信号，并且通过控制所述交流伺服电机(100)的位置以及伺服刚度来调节所述磨具(180，190)的法向磨削力。5.—种实现如权利要求1-4中任意一项所述的用于可调距螺旋桨机器人磨削的主动顺应末端执行器的控制方法，其中机器人具有主控制器，所述末端执行器的控制器为嵌入式微控制器，所述主控制器与所述嵌入式微控制器通过串行总线进行通讯，其特征在于，所述控制方法包括如下步骤: (1)由所述机器人的主控制器发出信号使所述末端执行器进入输出状态，所述控制器设置所述交流伺服电机(100)回到零位并保持较小的伺服刚度和阻尼;所述末端执行器接近待磨削工件表面的加工规划路径起始点； (2)执行磨削加工，所述力传感器(140)检测法向磨削力信号，若所述磨削力信号大于或小于阈值，所述控制器相应控制所述交流伺服电机(100)回退或前进使得所述力传感器(140)的输出保持在所述阈值或阈值附近波动，并反馈调整后的信号给所述机器人继续执 行磨削加工。
【专利摘要】本发明公开了一种用于可调距螺旋桨机器人磨削的主动顺应末端执行器及控制方法，主动顺应末端执行器包括：磨具，BT30刀柄，磨削电主轴，用于固定磨削电主轴的支架，用于检测法向磨削力的力传感器，用于安装力传感器的支座，用于检测末端位置偏差的位移传感器，用于固定位移传感器的支座，提供轴向移动自由度和传递扭矩的滚珠丝杠，用于支撑和固定滚珠丝杠的轴承座，滚珠丝杠螺母，滚珠丝杠螺母支座，交流伺服电机，用于连接伺服电机和滚珠丝杠的法兰支座与联轴器，直线导轨和滑块，底部支撑板，还包括用于驱动伺服电机的控制系统。本发明具有结构简单、装配方便、控制精度高、响应速度快的优点，同时可以自动更换磨具。
【IPC分类】B24B51/00, B24B41/00
【公开号】CN105563309
【申请号】CN201510764987
【发明人】杨文玉, 赵源, 陈琪琳
【申请人】华中科技大学
【公开日】2016年5月11日
【申请日】2015年11月11日