一. 力控插件简介
1. 功能介绍
为兼容与适配所有力传感器，并使用力传感器实现ARCS系统下机械臂运行自适应和零力控制等功能，因此使用此力控插件。插件目前支持使用机械臂内置传感器、坤维、宇力和鑫精诚传感器。
2. 插件部署介绍
2.1. 传感器插件部署
使用力控插件需要ARCS上位机版本为0.29.2-beta.15及以上，同时需要安装力控插件和配置相应参数，以上能通过插件部署压缩包进行一键部署，插件部署压缩包请向AUBO询问获取。将部署压缩包置于任意路径解压，使用终端到解压后的文件路径下，输入“sh install.sh 传感器类型”命令执行安装脚本，即可完成力控插件和传感器插件的部署和配置文件的参数写入。
目前支持的传感器类型有：kw，xinjingcheng，yuli
当看到图中的提示信息，即代表安装完成。注：首次切换到新的ARCS版本后需要重新部署。
2.2. 力控插件部署
打开ARCS上位机，点击右上角设置>系统>插件>新增，选择对应版本的插件压缩包，点击选择进行添加。
添加插件后，勾选力控插件，点击重启，即可完成插件的启用。
二. 插件操作界面介绍
1. 传感器配置界面
传感器配置界面如上图所示。
①用于选择使用的传感器品牌，目前支持内置传感器、坤维、宇力和鑫精诚传感器，选择完传感器之后，传感器就会立即请求数据；
②可勾选复选框，来显示或隐藏相应数据；
③勾选实时，即可在下方图表处显示力数据；
④在不勾选实时的情况下，点击保存，保存的数据为开始请求起的所有数据。在勾选实时的情况下，点击保存，按钮状态变更为停止，此时开始保存数据，再次点击停止，停止保存，保存的数据为两次点击之间的数据。
文件保存在/root/arcs_ws/extensions/force_control目录下，文件中前六组数据为使用的TCP的位姿，后六组数据为x、y、z方向上的力和力矩大小。注：文件保存路径和图表显示长度支持修改，需要至/root/arcs_ws/program/default.ins文件中进行修改，配置参数如图①②所示；
⑤图表实时显示除去偏置和负载的基于Base坐标系的力数据。支持显示Fx、Fy、Fz、Mx、My、Mz六组数据，分别表示x、y、z方向上的力和力矩大小。
以下介绍以鑫精诚传感器为例，其余传感器的使用类似。
2. 示教界面
①使用力控插件的相应功能前需要先在配置>一般>工具中心点处添加TCP。点击添加，然后输入工具中心点相对于法兰中心的偏移值，并将此TCP设置为默认，如图所示。
②然后进行传感器的标定，点击标定即可自动进行标定。注：在标定前务必保证传感器配置界面能正常读取力数据，且需要保证在标定过程中机械臂没有干涉，不会受到碰撞等影响。标定结束后，参数框会显示偏置、质量和质心数据，根据需要重新设置负载参数。
3. 标定位姿界面
进行标定有三组默认的位姿，分别为TCP的X轴正方向朝下、TCP的Y轴正方向朝下和TCP的Z轴正方向朝下，分别对应三组图片。
①单击示教界面的三组图片，可移动至标定位姿界面；
②双击示教界面的三组图片，可自行设置标定位姿，移动至想要的位姿，点击确认即可修改完成，自动保存。
三. 力控插件程序节点介绍
在程序节点中添加力控条件，点击编程>插件>ForceControl，即可添加力控条件，此条件分为力控条件配置和正常/异常退出力控条件后的流程实现。
注：正常/异常退出力控条件后都必须添加流程，程序停止后也应加入脚本fcDisable()，避免异常退出后力控未关闭。
1. 基础配置界面
①可自定义修改节点名称。
②选择参考坐标系，一般选择用户坐标系或者工具坐标系作为参考坐标系。
③力控开启方向，如果不需要该方向力，可取消勾选
④可设置目标力与对应速度限制。
⑤在配置----插件----力控----传感器配置界面可以査看实时的力控数据，如下所示，参考坐标系为上面②设置的坐标系。
2. 高级配置界面
高级配置界面能对六个方向上的阈值、阻尼和刚度参数进行配置，某个方向的参数能否修改，取决于示教界面相应方向的复选框是否勾选。
①阈值：在此界面修改暂无作用，需要到/root/arcs_ws/config/aubo_control.conf文件中进行修改；
②阻尼：描述推动机器人有多少阻力。阻力不会随机器人与参考点的距离而增加，而通常随机器人的速度而增加。
③刚度：描述机器人尝试返回参考点的力度。值越高，弹簧效果越强。将该值设置为零不会产生弹簧效应，并且机器人将沿所选方向浮动。
3. 停止条件界面
停止条件界面分为正常退出条件和异常退出条件。
①在正常退出条件中，可供选择的有目标力和稳态两种情况，满足条件即可退出力控条件，并进入力控正常退出流程。
选择目标力，即代表六个方向上满足目标力设置的阈值大小；
选择稳态，即代表机械臂运动队列为空，且保持相对静止。
②在异常退出条件中，可供选择的有超时一种情况，满足条件即可退出力控条件，并进入力控异常退出流程。选择超时，即代表开启力控后间隔设置时间还未退出力控。
四. 实例
1. 点按
要求：机械臂末端的笔以6N±1N的力垂直接触目标平面，接触后再回退。
思路：点按过程中力控阶段速度过快会导致目标力过冲，为避免这种情况且不降低节拍，选择在目标点上方3mm处开启力控，到达目标力后退出力控，力控阶段速度调低。其他阶段选择直线或者关节运动，速度可以根据实际情况设置。
[info] 点按实例相关文件
2. 连按
要求：机械臂末端的笔以10N±1N的力垂直接触目标平面，抬起后再以10N的目标力按下，接触后在回退。
思路：过程类似点按，在点按的基础上再加上一段抬起与点按的过程。
参数设置如下：
坐标系选择TCP
力控开启方向选择Z
目标力-10N
阻尼设置1000 ，可根据现场实际情况进行修改
退出条件为达到目标力±1N
[info] 连按实例相关文件
3. 画直线
要求：机械臂末端的笔以1N±0.5的力垂直接触目标平面，在平面上以1N±0.5N的力绘制一条直线。
思路：第一段过程类似点按，在以1N的目标力接触平面后退出力控，设置平面上另一点开启力控，维持1N的力直线运动过去，也可将两段力控合成一段，到达目标力后直接绘制直线，过程中不关闭力控。
参数设置如下：
坐标系选择TCP
力控开启方向选择Z
目标力-1N
阻尼设置1000 ，可根据现场实际情况进行修改
退出条件为第一阶段达到目标力±0.2N ，第二阶段稳态退出。
[info] 绘制直线实例相关文件
4. 画圆
要求：机械臂末端的笔以1N±0.5的力垂直接触目标平面，在平面上以1N±0.5N的力绘制一个圆。
思路：第一段过程类似点按，在以1N的目标力接触平面后，开启第二段力控，标定圆的三个点，以1N±0.5N的目标力绘制一个圆。
参数设置如下：
坐标系选择TCP
力控开启方向选择Z
目标力-1N
阻尼设置1000 ，可根据现场实际情况进行修改
退出条件为达到目标力±0.2N
[info] 绘制圆实例相关文件
5. 搜孔
要求：机械臂末端工件垂直接触目标孔洞，并对准孔洞完成插入。
思路：
第一段过程接近，类似点按，在以1N的目标力接触平面后停止力控;
第二段过程螺旋搜孔，以4N的目标力进行螺旋搜孔，当工件搜索到孔洞时，Z方向目标力突变减小到2N以内，触发现阶段力控停止条件;
第三段过程是插入，设置Z方向目标力为６N，XY方向目标力为０，使工件能沿着孔洞插入进去。
第一阶段，接近
坐标系选择TCP
力控开启方向选择Z
目标力-2N
阻尼设置1000 ，可根据现场实际情况进行修改
退出条件为达到目标力±0.2N
第二阶段，螺旋搜孔
坐标系选择TCP
力控开启方向选择Z
目标力-4N
阻尼设置2000 ，可根据现场实际情况进行修改
正常退出条件为维持稳态
异常退出条件为目标力，Z方向-2N~2N，勾选outside
第三阶段，插入
坐标系选择TCP
力控开启方向选择XYZ
目标力XY方向为0，Z方向-6N
阻尼设置1000，1000，2000 ，可根据现场实际情况进行修改
正常退出条件为维持稳态
[info] 搜孔实例相关文件