CN112775639B - 一种柔性装配系统及方法 - Google Patents

Abstract

本发明公开了一种柔性装配系统，包括工控机、数据采集卡、运动控制卡、六自由度装配平台、第一视觉平台、第二视觉平台和支承平台，六自由度装配平台包括四自由度运动平台和两自由度调节装置，两自由度调节装置包括两自由度运动平台、夹持机构，夹持机构包括外框、可转动连接在外框内的柔性腕、安装在柔性腕上的两个夹持片、与两个夹持片相对应的两个驱动件、设于外框上的两个第一测力传感器以及设于柔性腕上的两个第二测力传感器，第一视觉平台上安装有第一图像采集设备，第二视觉平台上安装有第二图像采集设备。本发明还公开了一种柔性装配方法。本发明快速消除零件装配过程中的振颤问题，提升零件装配的效率，提高装配过程的快速性、稳定性。

Description

一种柔性装配系统及方法

技术领域

本发明涉及微装配技术领域，尤其涉及一种柔性装配系统及方法。

背景技术

微装配技术在国防工业以及国民经济发展中有着重要的地位，在促进武器装备小型化、智能化，提升民用高科技产品性能方面发挥着重要的作用。因此，开发高精度、高效率和柔性化、智能化的装配机器人技术，取代传统的手工、半自动组装技术已成为主要发展方向，受到各工业大国的重视，并成为应对快速、小批量、定制化产业需求的关键技术手段之一。

目前，微夹持器的尺寸较大，很难做到集成传感器来检测外部受力；且容易受零件自身重力的影响，导致后续力的检测精度低。其次，对零件的柔性装配过程中遇到的震颤问题，一般会依赖于操作人员的经验进行主动干扰调整，或是等待零件自主趋于稳定，这都会耽误装配的时间，不能满足零件装配过程中对智能化、快速性的要求；此外，操作人员在操作过程也需要长时间集中精力，难以提供持续性的工作产出。而且，在目前的国内外研究当中，微装配系统通常要采用显微视觉和视觉伺服技术，系统设计相对复杂，对视觉传感器(摄像头)的精度要求较高，为了保证系统能自动操作，还需要相应操作环境的识别与定位技术和操作空间的自动转换与标定技术，以及采用系统辨识获取系统标定所需的转换矩阵(雅可比矩阵)参数等，无法达到多源信息的综合利用，比如视觉导航和力检测反馈相结合的技术。

发明内容

针对现有技术不足，本发明的目的在于提供一种柔性装配系统及方法。

为了实现上述目的，本发明一实施例提供的技术方案如下：

一种柔性装配系统，包括工控机、数据采集卡、运动控制卡、六自由度装配平台、第一视觉平台、第二视觉平台和支承平台，所述数据采集卡、运动控制卡均与所述工控机相连接，所述六自由度装配平台包括四自由度运动平台和两自由度调节装置，所述两自由度调节装置包括两自由度运动平台、安装在所述两自由度运动平台上的夹持机构，所述夹持机构包括外框、可转动连接在所述外框内的柔性腕、安装在所述柔性腕上的两个夹持片、与两个所述夹持片相对应的两个驱动件、设于所述外框上的两个第一测力传感器以及设于所述柔性腕上的两个第二测力传感器，所述第一视觉平台上安装有第一图像采集设备，所述第二视觉平台上安装有第二图像采集设备。

优选地，所述四自由度运动平台包括底座、第一电机、第二电机、第三电机、第四电机、安装在所述底座上的Y轴直线运动平台、安装在所述Y轴直线运动平台上的X轴直线运动平台、安装在所述X轴直线运动平台上的Z轴直线运动平台以及安装在所述Z轴直线运动平台上的Z轴旋转运动平台。

优选地，所述两自由度运动平台包括第五电机、第六电机、X轴旋转运动平台和Y轴旋转运动平台，所述第五电机驱动所述X轴旋转运动平台绕X轴旋转，所述第六电机驱动所述Y轴旋转运动平台绕Y轴旋转。

优选地，所述柔性腕包括外环和内环，所述外环与所述外框可转动连接，所述内环与所述外环可转动连接，两个所述夹持片安装在所述内环上，两个所述第一测力传感器分别为第一外环测力传感器、第二外环测力传感器，两个所述第二测力传感器分别为第一内环测力传感器、第二内环测力传感器，所述第一外环测力传感器、第二外环测力传感器相对安装在所述外框上，所述第一内环测力传感器、第二内环测力传感器相对安装在所述外环上，所述第一内环测力传感器、第二内环测力传感器、第一外环测力传感器、第二外环测力传感器均与所述数据采集卡相连接。

优选地，所述夹持片为铁片，所述驱动件为磁铁。

优选地，所述夹持片为压电陶瓷片，所述驱动件包括三根金属丝。

优选地，所述金属丝的直径为20μm。

优选地，所述内环上设置有安装孔，所述安装孔的中间部位连接有配重块，所述配重块上设置有至少一个配重孔。

一种柔性装配方法，使用上述系统，包括以下步骤：

(1)将第一待装配零件放入待夹持区域，将第二待装配零件放置在所述支承平台上；

(2)通过所述工控机控制两个所述夹持片夹持住第一待装配零件；

(3)所述工控机通过所述运动控制卡控制第一视觉平台、第二视觉平台移动，使第一图像采集设备、第二图像采集设备处于最佳视角位置；

(4)所述工控机获取所述第一图像采集设备、第二图像采集设备的图像信号从而获取第二待装配零件的位置与姿态，并控制六自由度装配平台粗调整第一待装配零件的姿态，接着工控机控制两自由度调节装置实现第一待装配零件夹持状态的稳定，再通过六自由度装配平台控制第一待装配零件接近第二待装配零件的过程中，缓慢完成第一待装配零件姿态的精调整；

(5)在第一待装配零件与第二待装配零件的装配接触阶段，工控机通过数据采集卡获取夹持第一待装配零件的力信号，在深入装配阶段，通过运动控制卡控制六自由度装配平台进行细微移动调整，最终完成第一待装配零件与第二待装配零件的装配。

优选地，所述步骤(4)中，工控机控制两自由度调节装置实现第一待装配零件夹持状态的稳定，包括：

当工控机检测到第一外环测力传感器的力信号时，此时外环处于沿X轴正方向绕X轴向左偏摆的状态，工控机控制两自由度旋转平台沿X轴正方向绕X轴向右偏摆；当工控机检测到第一外环测力传感器的力信号小于一定阈值时，外环与第一外环测力传感器处于脱离接触状态或者不受力状态；

当工控机检测到第二外环测力传感器的力信号时，外环处于沿X轴正方向绕X轴向右偏摆的状态，工控机控制两自由度旋转平台沿X轴正方向绕X轴向左偏摆；当工控机检测到第二外环测力传感器的力信号小于一定阈值时，此时外环与第二外环测力传感器处于脱离接触状态或者不受力状态；

当工控机检测到第一内环测力传感器的力信号时，内环处于沿Y轴正方向绕Y轴向左偏摆的状态，工控机控制两自由度旋转平台沿Y轴正方向绕Y轴向右偏摆；当工控机检测到第一内环测力传感器的力信号小于一定阈值时，此时内环与第一内环测力传感器处于脱离接触状态或者不受力状态；

当工控机检测到第二内环测力传感器的力信号时，内环处于沿Y轴正方向绕Y轴向右偏摆的状态，工控机控制两自由度旋转平台沿Y轴正方向绕Y轴向左偏摆；当工控机检测到第二内环测力传感器的力信号小于一定阈值时，此时内环与第二内环测力传感器处于脱离接触状态或者不受力状态；

当外环与第一外环测力传感器、第二外环测力传感器均处于脱离接触状态或者不受力状态时，此时外环、第一外环测力传感器、第二外环测力传感器均处于稳定状态，外环调节完毕；

当内环与第一内环测力传感器、第二内环测力传感器均处于脱离接触状态或者不受力状态时，此时内环、第一内环测力传感器、第二内环测力传感器均处于稳定状态，内环调节完毕；

当外环和内环均调节完毕，此时夹持的第一待装配零件调节完毕，处于稳定状态。

本发明的有益效果是：

(1)本发明结构简单，控制方法简单实用，且装置成本低，能够快速通过主动调整策略，快速消除零件装配过程中的振颤问题，节省零件调整时间，从而提升零件装配的效率，提高了装配过程的快速性、稳定性，智能高效，实用性强，可适用于两自由度柔性旋转装配的应用工作环境。

(2)本发明在进行微装配时，该装置可以消除零件自身重力对力的检测精度的影响，实现微牛级别微小受力的偏转检测，对于大尺寸零件的夹持，亦可实现微牛级别的力检测，同时实现了在微小装配空间中完成微力传感器的布置，极大的提高了微装配成功率和效率。

(3)本发明适用范围广，中小尺寸到大尺寸多个尺寸范围的零件的夹持，夹持器前端可实现大尺寸范围夹持，并且装配时，可提供较大的轴向力。

(4)本发明的第一内环测力传感器、第二内环测力传感器、第一外环测力传感器、第二外环测力传感器均为复合量程微力传感器，通过将具有不同力检测量程和力检测精度的三个悬臂梁平行排布，其能够利用该三个悬臂梁在力检测量程和力检测精度上的差异进行有机的结合与互补，以此利用该三个悬臂梁分别对不同力检测量程和/或力检测精度需求场合进行相应的力检测，以使得力传感器同时具备大力检测量程和高力检测精度，并且还通过相应的惠斯通电桥电路来实时检测悬臂梁的受力变化状态，从而改善力传感器的控制简便性和工作稳定性，微力传感器既提高了力检测分辨率，又增大了力测量量程范围，且通过惠斯通电桥电路检测力的变化，检测和控制方法简单，稳定性好。

(5)能够将二维力检测应用于微装配过程，使微装配不仅采用视觉导航而且能结合微力检测完成装配过程中力控制，解决了在微零件装配时，微零件自身重力对高力检测分辨率的影响的问题，将微装配过程中力检测分辨率提高uN级别，增加了夹持器的适用性，极大的增加了微装配过程中系列化夹持器的应用。

附图说明

为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明中记载的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。

图1为本发明的结构示意图；

图2为本发明的六自由度装配平台和支承平台的结构示意图；

图3为本发明的优选实施例一的两自由度调节装置的结构示意图；

图4为本发明的优选实施例一的夹持机构的俯视图；

图5为本发明的优选实施例一的夹持机构的侧视图；

图6为本发明的优选实施例一的夹持机构的结构示意图；

图7为本发明的优选实施例一的夹持机构的内部结构示意图；

图8为本发明的优选实施例一的外框与柔性腕的俯视图；

图9为本发明的优选实施例一的外壳上设置两个电磁铁的结构示意图；

图10为本发明提供的第一内环测力传感器、第二内环测力传感器、第一外环测力传感器、第二外环测力传感器的结构示意图；

图11为本发明提供的第一内环测力传感器、第二内环测力传感器、第一外环测力传感器、第二外环测力传感器中的电路布局结构示意图；

图12为本发明的优选实施例一的控制原理图；

图13为本发明的优选实施例二的两自由度调节装置的结构示意图；

图14为本发明的优选实施例二的外框、柔性腕和压电陶瓷片连接的结构示意图；

图15为本发明的优选实施例二的夹持机构的结构示意图；

图16为本发明的优选实施例二的控制原理图。

具体实施方式

为了使本技术领域的人员更好地理解本发明中的技术方案，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都应当属于本发明保护的范围。

实施例一

如图1-图12所示，一种柔性装配系统，包括工控机1、数据采集卡2、运动控制卡3、六自由度装配平台4、第一视觉平台5、第二视觉平台6和支承平台7，数据采集卡2、运动控制卡3均与工控机1相连接，六自由度装配平台4包括四自由度运动平台和两自由度调节装置，两自由度调节装置包括两自由度运动平台、安装在两自由度运动平台上的夹持机构，夹持机构包括外框401、可转动连接在外框401内的柔性腕、安装在柔性腕上的两个夹持片、与两个夹持片相对应的两个驱动件、设于外框401上的两个第一测力传感器以及设于柔性腕上的两个第二测力传感器，第一视觉平台5上安装有第一图像采集设备，第二视觉平台6上安装有第二图像采集设备，第一视觉平台5用于获取第一待装配零件和第二待装配零件的装配空间X轴方向的视场信息，第二视觉平台6用于获取第一待装配零件和第二待装配零件的装配空间Y轴方向的视场信息，支承平台7用于支撑第二待装配零件。

本发明优选四自由度运动平台包括底座402、第一电机403、第二电机404、第三电机405、第四电机406、安装在底座402上的Y轴直线运动平台407、安装在Y轴直线运动平台407上的X轴直线运动平台408、安装在X轴直线运动平台408上的Z轴直线运动平台409以及安装在Z轴直线运动平台409上的Z轴旋转运动平台410，第一电机403能够驱动Y轴直线运动平台407沿Y轴移动，第二电机404能够驱动X轴直线运动平台408沿X轴移动，第三电机404能够驱动Z轴直线运动平台409沿Z轴移动，第四电机406能够驱动Z轴旋转运动平台410绕Z轴旋转。优选地，Z轴旋转运动平台410采用的是骏河精机的标准360°旋转滑台，型号为KRW06360。

优选两自由度运动平台包括第五电机420、第六电机421、X轴旋转运动平台422和Y轴旋转运动平台423，第五电机420驱动X轴旋转运动平台422绕X轴旋转，第六电机421驱动Y轴旋转运动平台423绕Y轴旋转。进一步优选第五电机420的输出轴通过第一联轴器424与X轴旋转运动平台422相连接，第六电机421的输出轴通过第二联轴器425与Y轴旋转运动平台423相连接，外框401安装在Y轴旋转运动平台423上。

进一步优选X轴旋转运动平台422、Y轴旋转运动平台423均采用骏河精机的标准转动滑台，型号为KGW04040-L。

本发明优选柔性腕包括外环426和内环427，外环426与外框401可转动连接，内环427与外环426可转动连接，两个夹持片安装在内环427上，两个第一测力传感器分别为第一外环测力传感器428、第二外环测力传感器429，两个第二测力传感器分别为第一内环测力传感器430、第二内环测力传感器431，第一外环测力传感器428、第二外环测力传感器429相对安装在外框401上，第一内环测力传感器430、第二内环测力传感器431相对安装在外环426上，第一内环测力传感器430、第二内环测力传感器431、第一外环测力传感器428、第二外环测力传感器429均与数据采集卡2相连接。

本发明优选内环427内设置有安装孔432，安装孔432的中间部位连接有配重块433，通过配重块433来平衡夹持片和夹持零件的重量，使内环427始终保持平衡的状态，配重块433上设置有至少一个配重孔434，当更换夹持零件后由于零件的重量发生改变，可以在配重孔434中添加或者减少相应的重量，使装配过程相对简单并且增加了夹持片的适用性，降低成本。

为了便于外环426和内环427的转动，本发明优选外环426与外框401之间连接有至少一个第一销钉435，外环426能够绕X轴旋转，内环427与外环426之间连接有至少一个第二销钉436，内环427能够绕Y轴旋转。

优选地，夹持片为铁片437，驱动件为电磁铁438。两个铁片437相对设置，两个电磁铁438相对设置，每个铁片437的一端安装在内环427上，另一端从两个电磁铁438之间穿过。工控机1连接微控制器8，微控制器8连接两个电磁铁驱动电路9，两个电磁铁438分别与两个电磁铁驱动电路9连接。

为了便于电磁铁438的安装，本发明还包括外壳439，外壳439与外框401固定连接，两个电磁铁438均安装在外壳439上，每个铁片437的另一端伸出外壳439。优选每个铁片437的一端粘连在安装孔432的侧壁上，配重块433粘连在安装孔432的中间部位。优选每个铁片437的另一端连接有接触头440，便于稳定的夹持零件。优选接触头440与铁片437采用胶水粘接。

本发明还设置有后盖441，后盖441与外框401固定连接。

为了便于第一电机403、第二电机404、第三电机405、第四电机406、第五电机420、第六电机421、第七电机501、第八电机502、第九电机503、第十电机601、第十一电机602、第十二电机603的启动或停止，本发明优选运动控制卡3连接有多个电机驱动器11，第一电机403、第二电机404、第三电机405、第四电机406、第五电机420、第六电机421、第七电机501、第八电机502、第九电机503、第十电机601、第十一电机602、第十二电机603分别与对应的电机驱动器11相连接。

本发明优选微控制器8为arduino nano。优选数据采集卡2为阿尔泰公司的多功能数据采集卡PCI-8062。优选运动控制卡3为雷赛12轴运动控制卡DMC3C00。优选电机驱动器11的型号为KR-A55MB。电磁铁驱动电路9，就是给一个电磁铁438一个12V的电压，电磁铁438通电生磁，就可吸附铁片437。优选电磁铁437采用直流电磁铁工业吸盘，LY-1809，DC12V/吸力1.2kg。

本发明优选第一内环测力传感器430、第二内环测力传感器431、第一外环测力传感器428、第二外环测力传感器429均为复合量程微力传感器，包括第一悬臂梁450、第二悬臂梁451和第三悬臂梁452；其中，该第一悬臂梁450、该第二悬臂梁451和该第三悬臂梁452依次平行排布在同一平面上；该第一悬臂梁450、该第二悬臂梁451和该第三悬臂梁452具有相同的长度和相同的厚度；该第一悬臂梁450、该第二悬臂梁451和该第三悬臂梁452的宽度依次递增；该第一悬臂梁450连接有第一测量电路，该第一测量电路用于将该第一悬臂梁450检测到的力信号转换为电信号；该第二悬臂梁451连接有第二测量电路，该第二测量电路用于将该第二悬臂梁451检测到的力信号转换为电信号；该第三悬臂梁452连接有第三测量电路，该第三测量电路用于将该第三悬臂,64检测到的力信号转换为电信号；该第一悬臂梁450、该第二悬臂梁451和该第三悬臂梁452的力信号检测分辨率依次减小；该第一悬臂梁450、该第二悬臂梁451和该第三悬臂梁452的力信号检测量程依次增大。

上述复合量程微力传感器的技术方案的有益效果为：该复合量程微力传感器通过将具有不同力检测量程和力检测精度的三个悬臂梁平行排布，其能够利用该三个悬臂梁在力检测量程和力检测精度上的差异进行有机的结合与互补，以此利用该三个悬臂梁分别对不同力检测量程和/或力检测精度需求场合进行相应的力检测，以使得力传感器同时具备大力检测量程和高力检测精度，并且还通过相应的惠斯通电桥电路来实时检测悬臂梁的受力变化状态，从而改善力传感器的控制简便性和工作稳定性。具体而言，由于当力传感器中悬臂梁的宽度越大，其对应的力检测量程越大且力检测精度越小，相反地，当力传感器中悬臂梁的宽度越小，其对应的力检测量程越小且力检测精度越大，该复合量程微力传感器通过将三个具有不同宽度的悬臂梁依次平行排布，这样能够使得力传感器能够在实际测量过程中进行高精度和大量程的力值测量，从而提高力传感器的测量可靠性和稳定性。

优选地，该复合量程微力传感器还包括固定端面453，该固定端面453设置在该同一平面上；该第一悬臂梁450、该第二悬臂梁451和该第三悬臂梁452各自包括相对设置的一固定端和一自由端；该第一悬臂梁450、该第二悬臂梁451和该第三悬臂梁452各自的固定端均与该固定端面453连接。

上述技术方案的有益效果为：通过在同一平面上设置固定端面，并将第一悬臂梁、第二悬臂梁和第三悬臂梁的固定端共同设置在该固定端面上，能够有效地对三个悬臂梁进行固定安装和保证三个悬臂梁相对位置的稳固性。

优选地，该第一悬臂梁450的自由端设置有第一凸台454；该第二悬臂梁451的自由端设置有第二凸台455；该第一凸台454的高度大于该第二凸台455的高度。

上述技术方案的有益效果为：该第一悬臂梁和第二悬臂梁的自由端设置有高度不同的凸台，并且该第三悬臂梁的自由端没有设置任何凸台，这使得三个悬臂梁的自由端具有不同的相对高度位置，从而保证在测量过程中，三个悬臂梁同时接触到待检测的微小力信号，以保证在同一时刻只有一个悬臂梁接触到待检测的微小力信号，以此保证力传感器的测量准确性。在实际测量中，由于第一悬臂梁自由端上的凸台具有最高的高度，这使得该第一悬臂梁会首先接触到待检测的微小力信号，此时的检测过程对应具有最小的力检测量程和最大的力检测精度，并在第一悬臂梁达到最大力检测值前，第二悬臂梁自由端对应的凸台会接触到待检测的微小力信号，同样地在第二悬臂梁达到最大力检测值前，第三悬臂梁的自由端会接触到待检测的微小力信号，此时的检测过程对应具有最大的力检测精度，通过上述从第一悬臂梁到第二悬臂梁再到第三悬臂梁的依次递减测量过程，能够同时实现大力检测量程和高力检测精度的测量操作。

优选地，该第一测量电路为第一惠斯通电桥测量电路；其中，

该第一惠斯通电桥测量电路包括四个力敏电阻R1、R2、R3、R4；

该力敏电阻R2和R3设置在该第一悬臂梁450处于受力状态时形变最大的区域，该力敏电阻R2和R3的电阻随着该第一悬臂梁450的形变强度变化而变化，该力敏电阻R1和R4设置在该复合量程微力传感器的固定端面453上，该力敏电阻R1和R4的电阻不随该第一悬臂梁450发生形变而变化。

优选地，该力敏电阻R1、R2、R3、R4依次首尾电连接；

该力敏电阻R1和R2的相连端与该第一惠斯通电桥测量电路的输出电极EO1相连，该力敏电阻R1和R3的相连端与该第一惠斯通电桥测量电路的输入电极EI1相连，该力敏电阻R2和R4的相连端与该第一惠斯通电桥测量电路的输入电极EI2相连，该力敏电阻R3和R4的相连端与该第一惠斯通电桥测量电路的输出电极EO2相连；该第一惠斯通电桥测量电路的输入电极EI1和该第一惠斯通电桥测量电路的输入电极EI2分别连接输入电压两端，该第一惠斯通电桥测量电路的输出电极EO1和该第一惠斯通电桥测量电路的输出电极EO2用于输出测量电压。

上述技术方案的有益效果为：在实际测量中，第一悬臂梁自由端的凸台接触到待检测的微小力信号，此时第一悬臂梁的根部会发生形变，从而使得力敏电阻R2和R3随着第一悬臂梁发生形变而产生电阻阻值的变化，并使得该第一惠斯通电桥测量电路输出的电压发生变化，最终通过输出电压与力信号之间的比例关系能够计算获得该力信号对应的力值大小。

优选地，该第二测量电路为第二惠斯通电桥测量电路；其中，

该第二惠斯通电桥测量电路包括四个力敏电阻R5、R6、R7、R8；

该力敏电阻R6和R7设置在该第二悬臂梁451处于受力状态时形变最大的区域，该力敏电阻R6和R7的电阻随着该第二悬臂梁451的形变强度变化而变化，该力敏电阻R5和R8设置在该复合量程微力传感器的固定端面453上，该力敏电阻R5和R8的电阻不随该第二悬臂梁451发生形变而变化。

优选地，该力敏电阻R5、R6、R3、R4依次首尾电连接；

该力敏电阻R5和R6的相连端与该第二惠斯通电桥测量电路的输出电极EO1相连，该力敏电阻R5和R7的相连端与该第二惠斯通电桥测量电路的输入电极EI1相连，该力敏电阻R6和R8的相连端与该第二惠斯通电桥测量电路的输入电极EI2相连，该力敏电阻R7和R8的相连端与该第二惠斯通电桥测量电路的输出电极EO2相连；该第二惠斯通电桥测量电路的输入电极EI1和该第二惠斯通电桥测量电路的输入电极EI2分别连接输入电压两端，该第二惠斯通电桥测量电路的输出电极EO1和该第二惠斯通电桥测量电路的输出电极EO2用于输出测量电压。

上述技术方案的有益效果为：在实际测量中，第二悬臂梁自由端的凸台接触到待检测的微小力信号，此时第二悬臂梁的根部会发生形变，从而使得力敏电阻R6和R7随着第二悬臂梁发生形变而产生电阻阻值的变化，并使得该第二惠斯通电桥测量电路输出的电压发生变化，最终通过输出电压与力信号之间的比例关系能够计算获得该力信号对应的力值大小。

优选地，该第三测量电路为第三惠斯通电桥测量电路；其中，

该第三惠斯通电桥测量电路包括四个力敏电阻R9、R10、R11、R12；该力敏电阻R10和R11设置在该第三悬臂梁452处于受力状态时形变最大的区域，该力敏电阻R10和R11的电阻随着该第三悬臂梁452的形变强度变化而变化，该力敏电阻R9和R12设置在该复合量程微力传感器的固定端面453上，该力敏电阻R9和R12的电阻不随该第三悬臂梁452发生形变而变化。

优选地，该力敏电阻R9、R10、R11、R12依次首尾电连接；

该力敏电阻R9和R10的相连端与该第三惠斯通电桥测量电路的输出电极EO1相连，该力敏电阻R9和R11的相连端与该第三惠斯通电桥测量电路的输入电极EI1相连，该力敏电阻R10和R12的相连端与该第三惠斯通电桥测量电路的输入电极EI2相连，该力敏电阻R11和R12的相连端与该第三惠斯通电桥测量电路的输出电极EO2相连；该第三惠斯通电桥测量电路的输入电极EI1和该第三惠斯通电桥测量电路的输入电极EI2分别连接输入电压两端，该第三惠斯通电桥测量电路的输出电极EO1和该第三惠斯通电桥测量电路的输出电极EO2用于输出测量电压。

上述技术方案的有益效果为：在实际测量中，第三悬臂梁的自由端接触到待检测的微小力信号，此时第三悬臂梁的根部会发生形变，从而使得力敏电阻R10和R11随着第三悬臂梁发生形变而产生电阻阻值的变化，并使得该第三惠斯通电桥测量电路输出的电压发生变化，最终通过输出电压与力信号之间的比例关系能够计算获得该力信号对应的力值大小。

优选地，该第一悬臂梁450、该第二悬臂梁451和该第三悬臂梁452的长度为1000-3000μm；或者，该第一悬臂梁450、该第二悬臂梁451和该第三悬臂梁452的厚度为50-100μm；或者，该第一悬臂梁450的宽度为500μm，该第二悬臂梁451的宽度为3000μm，该第三悬臂梁452的宽度为10000μm；或者；该第一悬臂梁450的最小力信号检测分辨率为10μN，该第一悬臂梁450的力信号检测量程为10-400μN；或者；该第二悬臂梁451的最小力信号检测分辨率为400μN，该第二悬臂梁451的力信号检测量程为400-30000μN；或者；该第三悬臂梁452的最小力信号检测分辨率为2000μN，该第三悬臂梁452的力信号检测量程为2000-250000μN；或者，该第一悬臂梁450、该第二悬臂梁451和该第三悬臂梁452均在SiO2上通过光刻工艺制作形成。

在实际应用中，该第一悬臂梁450、该第二悬臂梁451和该第三悬臂梁452的长度、宽度和高度尺寸具体可如下面表1所示：

表1

特别地，该第一悬臂梁450采用根部挖空设计，这样能够保证该第一悬臂梁450在三个悬臂梁中具有最高的力检测灵敏度，其能够满足20μN的微力检测分辨率。可选地，可以在该第一悬臂梁450的根部挖出形成100μm*100μm的方形槽孔。

在实际应用中，该第一悬臂梁450、该第二悬臂梁451和该第三悬臂梁452的检测参数具体可如下面表2所示：

表2

另外，该第一悬臂梁450、该第二悬臂梁451和该第三悬臂梁452的制作工艺流程可包括：

(1)在基底的表面热生长形成一层厚度为25nm的SiO₂，以此作为离子注入保护层；

(2)在SiO₂的正面旋涂一层厚度为2μm的光刻胶；

(3)对该光刻胶进行光刻处理，以光刻胶作为掩膜刻蚀形成力敏电阻槽；

(4)在该力敏电阻槽内注入高浓度硼离子，以此形成力敏电阻，其中高浓度硼离子的注入能量为50KeV、注入剂量为214cm²，然后对该力敏电阻进行1100℃和40s的退火处理，再在该力敏电阻表面上形成一层厚度为0.3μm的氧化层；

(5)对该光刻胶上刻蚀形成引线孔，该引线孔的刻蚀对应的注入能量为50KeV、注入剂量为215cm²，然后进行1100℃和40s的退火处理；

(6)在该引线孔进行金属溅射，从而形成700nm的Al引线，并进行4500℃和20min的退火处理；

(7)在基底的表面进行等离子体增强化学气相沉积处理，以此形成厚度为1μm的SiN绝缘介质层；

(8)在SiN绝缘介质层上形成图案化的接触焊盘；

(9)对基底进行各项同性处理、掏出反应腔和释放悬臂梁。

从上述实施例的内容可知，该复合量程微力传感器包括第一悬臂梁、第二悬臂梁和第三悬臂梁；其中，该第一悬臂梁、该第二悬臂梁和该第三悬臂梁依次平行排布在同一平面上；该第一悬臂梁、该第二悬臂梁和该第三悬臂梁具有相同的长度和相同的厚度；该第一悬臂梁、该第二悬臂梁和该第三悬臂梁的宽度依次递增；该第一悬臂梁连接有第一测量电路，该第一测量电路用于将所述第一悬臂梁检测到的力信号转换为电信号；该第二悬臂梁连接有第二测量电路，该第二测量电路用于将该第二悬臂梁检测到的力信号转换为电信号；该第三悬臂梁连接有第三测量电路该第三测量电路用于将该第三悬臂梁检测到的力信号转换为电信号；该第一悬臂梁、该第二悬臂梁和该第三悬臂梁的力信号检测检测分辨率减小；该第一悬臂梁、该第二悬臂梁和该第三悬臂梁的力信号检测量程依次增大；可见，该复合量程微力传感器通过将具有不同力检测量程和力检测精度的三个悬臂梁平行排布，其能够利用该三个悬臂梁在力检测量程和力检测精度上的差异进行有机的结合与互补，以此利用该三个悬臂梁分别对不同力检测量程和/或力检测精度需求场合进行相应的力检测，以使得力传感器同时具备大力检测量程和高力检测精度，并且还通过相应的惠斯通电桥电路来实时检测悬臂梁的受力变化状态，从而改善力传感器的控制简便性和工作稳定性。

本发明优选第一视觉平台5包括第七电机501、第八电机502、第九电机503、第一视觉Y轴运动平台504、第一视觉X轴运动平台505、第一视觉Z轴运动平台506，第七电机501驱动第一视觉Y轴运动平台504沿Y轴移动，第八电机502驱动第一视觉X轴运动平台505沿X轴移动，第九电机503驱动第一视觉Z轴运动平台506沿Z轴移动。

本发明优选第二视觉平台6包括第十电机601、第十一电机602、第十二电机603、第二视觉X轴运动平台604、第二视觉Y轴运动平台605、第二视觉Z轴运动平台606，第十电机601驱动第二视觉X轴运动平台604沿Y轴移动，第十一电机602驱动第二视觉Y轴运动平台605沿X轴移动，第十二电机603驱动第二视觉Z轴运动平台606沿Z轴移动。进一步优选第一图像采集设备为第一CCD相机507，第二图像采集设备为第二CCD相机607。进一步优选还包括图像采集卡10，第一CCD相机507、第二CCD相机607均与图像采集卡10相连接，图像采集卡10与工控机1相连接。

以下介绍本发明实施例一的一种柔性装配方法，使用本发明实施例一的柔性装配系统，包括以下步骤：

(1)将第一待装配零件放入待夹持区域，将第二待装配零件放置在支承平台7上。

其中，在将第一待装配零件放入待夹持区域之前，还包括通过工控机1发送信号给微控制器8，电磁铁驱动电路9控制两个电磁铁438通电，两个电磁铁438分别吸住两个铁片437，使两个铁片437前端均张开一定角度。

待夹持区域为两个接触头440之间的区域，提高对第一待装配零件夹持的稳定性。

(2)通过工控机1控制两个夹持片夹持住第一待装配零件。

具体的，通过工控机1发送信号给微控制器8，微控制器8发送信号给电磁铁驱动电路9，电磁铁驱动电路9使得电磁铁438断电，电磁铁438去磁，铁片437恢复形变，实现对第一待装配零件的夹持。

(3)工控机1通过运动控制卡3控制第一视觉平台5、第二视觉平台6移动，使第一图像采集设备、第二图像采集设备处于最佳视角位置。

具体的，运动控制卡3通过电机驱动器11，控制第七电机501、第八电机502、第九电机503工作，进而分别控制第一视觉Y轴运动平台504、第一视觉X轴运动平台505、第一视觉Z轴运动平台506移动，使得第一CCD相机507处于最佳视角位置；同时运动控制卡3通过电机驱动器11，控制第十电机601、第十一电机602、第十二电机603工作，进而分别控制第二视觉X轴运动平台604、第二视觉Y轴运动平台605、第二视觉Z轴运动平台606移动，使得第二CCD相机607处于最佳视角位置。

(4)工控机1获取第一图像采集设备、第二图像采集设备的图像信号从而获取第二待装配零件的位置与姿态，并控制六自由度装配平台4粗调整第一待装配零件的姿态，接着工控机1控制两自由度调节装置实现第一待装配零件夹持状态的稳定，再通过六自由度装配平台4控制第一待装配零件接近第二待装配零件的过程中，缓慢完成第一待装配零件姿态的精调整。

具体的，工控机1通过图像采集卡10获取第一CCD相机507、第二CCD相机607的图像信号从而获取第二待装配零件的位置与姿态。

具体的，工控机1通过运动控制卡3控制电机驱动器11，电机驱动器11控制第四电机406、第五电机420、第六电机421，进而控制Z轴旋转运动平台410、X轴旋转运动平台422、Y轴旋转运动平台423转动，带动第一待装配零件旋转，实现对第一待装配零件的姿态的粗调整。

当工控机1通过数据采集卡2检测到第一外环测力传感器428的力信号时，外环426处于沿X轴正方向绕X轴向左偏摆的状态，工控机1发送信号给运动控制卡3，运动控制卡3发送信号给电机驱动器11，第五电机420驱动X轴旋转运动平台422沿X轴正方向绕X轴向右偏摆；当工控机1通过数据采集卡2检测到第一外环测力传感器428的力信号小于一定阈值时，外环426与第一外环测力传感器428处于脱离接触状态或者不受力状态；

当工控机1通过数据采集卡2检测到第二外环测力传感器429的力信号时，外环426处于沿X轴正方向绕X轴向右偏摆的状态，工控机1发送信号给运动控制卡3，运动控制卡3发送信号给电机驱动器11，第五电机420驱动X轴旋转运动平台422沿X轴正方向绕X轴向左偏摆；当工控机1通过数据采集卡2检测到第二外环测力传感器429的力信号小于一定阈值时，此时外环426与第二外环测力传感器429处于脱离接触状态或者不受力状态；

当工控机1通过数据采集卡2检测到第一内环测力传感器430的力信号时，内环427处于沿Y轴正方向绕Y轴向左偏摆的状态，工控机1发送信号给运动控制卡3，运动控制卡3发送信号给电机驱动器11，第六电机421驱动Y轴旋转运动平台423沿Y轴正方向绕Y轴向右偏摆；当工控机1通过数据采集卡2检测到第一内环测力传感器430的力信号小于一定阈值时，此时内环427与第一内环测力传感器430处于脱离接触状态或者不受力状态；

当工控机1通过数据采集卡2检测到第二内环测力传感器431的力信号时，内环427处于沿Y轴正方向绕Y轴向右偏摆的状态，工控机1发送信号给运动控制卡3，运动控制卡3发送信号给电机驱动器11，第六电机421驱动Y轴旋转运动平台423沿Y轴正方向绕Y轴向左偏摆；当工控机1通过数据采集卡2检测到第二内环测力传感器431的力信号小于一定阈值时，此时内环427与第二内环测力传感器431处于脱离接触状态或者不受力状态；

当外环426与第一外环测力传感器428、第二外环测力传感器429均处于脱离接触状态或者不受力状态时，此时外环426、第一外环测力传感器428、第二外环测力传感器429均处于稳定状态，外环426调节完毕；

当内环427与第一内环测力传感器430、第二内环测力传感器431均处于脱离接触状态或者不受力状态时，此时内环427、第一内环测力传感器430、第二内环测力传感器431均处于稳定状态，内环427调节完毕；

当外环426和内环427均调节完毕，此时夹持的第一待装配零件调节完毕，处于稳定状态。

(5)在第一待装配零件与第二待装配零件的装配接触阶段，工控机1通过数据采集卡2获取夹持第一待装配零件的力信号，从而实时获取第一待装配零件与第二待装配零件的装配接触状态，控制相应的电机做出相应的位置调整，在深入装配阶段，通过运动控制卡3控制六自由度装配平台4进行细微移动调整，最终完成第一待装配零件与第二待装配零件的装配。

实施例二

如图1、图2、图10、图11、图13-图16所示，本发明实施例二的柔性装配系统与实施例一的柔性装配系统的区别在于：

夹持片为压电陶瓷片460，驱动件包括三根金属丝。优选地，压电陶瓷片460上有三个接线柱(图中未示出)，三根金属丝分别焊接在对应的三个接线柱上。优选地，金属丝的直径为20μm，能够实现与接线柱的焊接，避免融化，同时能够避免影响内环427的转动。优选地，金属丝为银丝461，但并不局限于银丝，也可以为金丝。优选地，还设置有压电陶瓷片驱动电路12，微控制器8与压电陶瓷片驱动电路12相连接，压电陶瓷片驱动电路12通过三根银丝461与压电陶瓷片460相连接。本实施例优选压电陶瓷片驱动电路12采用150V三通道电源，型号是HPV系列压电陶瓷驱动电源系统。

本实施例二还提供了一种柔性装配方法，使用本发明实施例二的柔性装配系统，包括以下步骤：

(1)将第一待装配零件放入待夹持区域，将第二待装配零件放置在支承平台7上。

待夹持区域为两个接触头440之间的区域，提高对第一待装配零件夹持的稳定性。

(2)通过工控机1控制两个夹持片夹持住第一待装配零件。

具体的，通过工控机1发送信号给微控制器8，微控制器8发送信号给压电陶瓷片驱动电路12，压电陶瓷片驱动电路12使得银丝461通电，压电陶瓷片460发生弯曲，夹持住第一待装配零件。

(3)工控机1通过运动控制卡3控制第一视觉平台5、第二视觉平台6移动，使第一图像采集设备、第二图像采集设备处于最佳视角位置。

具体的，运动控制卡3通过电机驱动器11，控制第七电机501、第八电机502、第九电机503工作，进而分别控制第一视觉Y轴运动平台504、第一视觉X轴运动平台505、第一视觉Z轴运动平台506移动，使得第一CCD相机507处于最佳视角位置；同时运动控制卡3通过电机驱动器11，控制第十电机601、第十一电机602、第十二电机603工作，进而分别控制第二视觉X轴运动平台604、第二视觉Y轴运动平台605、第二视觉Z轴运动平台606移动，使得第二CCD相机607处于最佳视角位置。

(4)工控机1获取第一图像采集设备、第二图像采集设备的图像信号从而获取第二待装配零件的位置与姿态，并控制六自由度装配平台4粗调整第一待装配零件的姿态，接着工控机1控制两自由度调节装置实现第一待装配零件夹持状态的稳定，再通过六自由度装配平台4控制第一待装配零件接近第二待装配零件的过程中，缓慢完成第一待装配零件姿态的精调整。

具体的，工控机1通过图像采集卡10获取第一CCD相机507、第二CCD相机607的图像信号从而获取第二待装配零件的位置与姿态。

具体的，工控机1通过运动控制卡3控制电机驱动器11，电机驱动器11控制第四电机406、第五电机420、第六电机421，进而控制Z轴旋转运动平台410、X轴旋转运动平台422、Y轴旋转运动平台423转动，带动第一待装配零件旋转，实现对第一待装配零件的姿态的粗调整。

当工控机1通过数据采集卡2检测到第一外环测力传感器428的力信号时，外环426处于沿X轴正方向绕X轴向左偏摆的状态，工控机1发送信号给运动控制卡3，运动控制卡3发送信号给电机驱动器11，第五电机420驱动X轴旋转运动平台422沿X轴正方向绕X轴向右偏摆；当工控机1通过数据采集卡2检测到第一外环测力传感器428的力信号小于一定阈值时，外环426与第一外环测力传感器428处于脱离接触状态或者不受力状态；

当工控机1通过数据采集卡2检测到第二外环测力传感器429的力信号时，外环426处于沿X轴正方向绕X轴向右偏摆的状态，工控机1发送信号给运动控制卡3，运动控制卡3发送信号给电机驱动器11，第五电机420驱动X轴旋转运动平台422沿X轴正方向绕X轴向左偏摆；当工控机1通过数据采集卡2检测到第二外环测力传感器429的力信号小于一定阈值时，此时外环426与第二外环测力传感器429处于脱离接触状态或者不受力状态；

当工控机1通过数据采集卡2检测到第一内环测力传感器430的力信号时，内环427处于沿Y轴正方向绕Y轴向左偏摆的状态，工控机1发送信号给运动控制卡3，运动控制卡3发送信号给电机驱动器11，第六电机421驱动Y轴旋转运动平台423沿Y轴正方向绕Y轴向右偏摆；当工控机1通过数据采集卡2检测到第一内环测力传感器430的力信号小于一定阈值时，此时内环427与第一内环测力传感器430处于脱离接触状态或者不受力状态；

当工控机1通过数据采集卡2检测到第二内环测力传感器431的力信号时，内环427处于沿Y轴正方向绕Y轴向右偏摆的状态，工控机1发送信号给运动控制卡3，运动控制卡3发送信号给电机驱动器11，第六电机421驱动Y轴旋转运动平台423沿Y轴正方向绕Y轴向左偏摆；当工控机1通过数据采集卡2检测到第二内环测力传感器431的力信号小于一定阈值时，此时内环427与第二内环测力传感器431处于脱离接触状态或者不受力状态；

当外环426与第一外环测力传感器428、第二外环测力传感器429均处于脱离接触状态或者不受力状态时，此时外环426、第一外环测力传感器428、第二外环测力传感器429均处于稳定状态，外环426调节完毕；

当内环427与第一内环测力传感器430、第二内环测力传感器431均处于脱离接触状态或者不受力状态时，此时内环427、第一内环测力传感器430、第二内环测力传感器431均处于稳定状态，内环427调节完毕；

当外环426和内环427均调节完毕，此时夹持的第一待装配零件调节完毕，处于稳定状态。

(5)在第一待装配零件与第二待装配零件的装配接触阶段，工控机1通过数据采集卡2获取夹持第一待装配零件的力信号，从而实时获取第一待装配零件与第二待装配零件的装配接触状态，控制相应的电机做出相应的位置调整，在深入装配阶段，通过运动控制卡3控制六自由度装配平台4进行细微移动调整，最终完成第一待装配零件与第二待装配零件的装配。

具体的，工控机1通过数据采集卡2获取第一外环测力传感器428、第二外环测力传感器429、第一内环测力传感器430、第二内环测力传感器431、的力信号从而获取夹持第一待装配零件的力信号，从而实时获取第一待装配零件与第二待装配零件的装配接触状态，再通过运动控制卡3使得各自的电机驱动器11驱动对应的电机转动，进而使得第一待装配零件旋转，在深入装配阶段，通过运动控制卡3使得各自的电机驱动器11驱动第一电机403、第二电机403、第三电机405，实现第一待装配零件的沿X轴、Y轴、Z轴方向进行细微移动调整，最终完成第一待装配零件与第二待装配零件的装配。

对于本领域技术人员而言，显然本发明不限于上述示范性实施例的细节，而且在不背离本发明的精神或基本特征的情况下，能够以其他的具体形式实现本发明。因此，无论从哪一点来看，均应将实施例看作是示范性的，而且是非限制性的，本发明的范围由所附权利要求而不是上述说明限定，因此旨在将落在权利要求的等同要件的含义和范围内的所有变化囊括在本发明内。不应将权利要求中的任何附图标记视为限制所涉及的权利要求。

此外，应当理解，虽然本说明书按照实施方式加以描述，但并非每个实施方式仅包含一个独立的技术方案，说明书的这种叙述方式仅仅是为清楚起见，本领域技术人员应当将说明书作为一个整体，各实施例中的技术方案也可以经适当组合，形成本领域技术人员可以理解的其他实施方式。

Claims (9)

1.一种柔性装配系统，其特征在于，包括工控机、数据采集卡、运动控制卡、六自由度装配平台、第一视觉平台、第二视觉平台和支承平台，所述数据采集卡、运动控制卡均与所述工控机相连接，所述六自由度装配平台包括四自由度运动平台和两自由度调节装置，所述两自由度调节装置包括两自由度运动平台、安装在所述两自由度运动平台上的夹持机构，所述夹持机构包括外框、可转动连接在所述外框内的柔性腕、安装在所述柔性腕上的两个夹持片、与两个所述夹持片相对应的两个驱动件、设于所述外框上的两个第一测力传感器以及设于所述柔性腕上的两个第二测力传感器，所述柔性腕包括外环和内环，所述外环与所述外框可转动连接，所述内环与所述外环可转动连接，两个所述夹持片安装在所述内环上，两个所述第一测力传感器分别为第一外环测力传感器、第二外环测力传感器，两个所述第二测力传感器分别为第一内环测力传感器、第二内环测力传感器，所述第一外环测力传感器、第二外环测力传感器相对安装在所述外框上，所述第一内环测力传感器、第二内环测力传感器相对安装在所述外环上，所述第一内环测力传感器、第二内环测力传感器、第一外环测力传感器、第二外环测力传感器均与所述数据采集卡相连接，所述第一视觉平台上安装有第一图像采集设备，所述第二视觉平台上安装有第二图像采集设备。

2.根据权利要求1所述的一种柔性装配系统，其特征在于，所述四自由度运动平台包括底座、第一电机、第二电机、第三电机、第四电机、安装在所述底座上的Y轴直线运动平台、安装在所述Y轴直线运动平台上的X轴直线运动平台、安装在所述X轴直线运动平台上的Z轴直线运动平台以及安装在所述Z轴直线运动平台上的Z轴旋转运动平台。

3.根据权利要求2所述的一种柔性装配系统，其特征在于，所述两自由度运动平台包括第五电机、第六电机、X轴旋转运动平台和Y轴旋转运动平台，所述第五电机驱动所述X轴旋转运动平台绕X轴旋转，所述第六电机驱动所述Y轴旋转运动平台绕Y轴旋转。

4.根据权利要求1所述的一种柔性装配系统，其特征在于，所述夹持片为铁片，所述驱动件为磁铁。

5.根据权利要求1所述的一种柔性装配系统，其特征在于，所述夹持片为压电陶瓷片，所述驱动件包括三根金属丝。

6.根据权利要求5所述的一种柔性装配系统，其特征在于，所述金属丝的直径为20μm。

7.根据权利要求1所述的一种柔性装配系统，其特征在于，所述内环上设置有安装孔，所述安装孔的中间部位连接有配重块，所述配重块上设置有至少一个配重孔。

8.一种柔性装配方法，其特征在于，使用如权利要求1-7中任一项所述的系统，包括以下步骤：

(1)将第一待装配零件放入待夹持区域，将第二待装配零件放置在所述支承平台上；

(2)通过所述工控机控制两个所述夹持片夹持住第一待装配零件；

(3)所述工控机通过所述运动控制卡控制第一视觉平台、第二视觉平台移动，使第一图像采集设备、第二图像采集设备处于最佳视角位置；

(4)所述工控机获取所述第一图像采集设备、第二图像采集设备的图像信号从而获取第二待装配零件的位置与姿态，并控制六自由度装配平台粗调整第一待装配零件的姿态，接着工控机控制两自由度调节装置实现第一待装配零件夹持状态的稳定，再通过六自由度装配平台控制第一待装配零件接近第二待装配零件的过程中，缓慢完成第一待装配零件姿态的精调整；

(5)在第一待装配零件与第二待装配零件的装配接触阶段，工控机通过数据采集卡获取夹持第一待装配零件的力信号，在深入装配阶段，通过运动控制卡控制六自由度装配平台进行细微移动调整，最终完成第一待装配零件与第二待装配零件的装配。

9.根据权利要求8所述的一种柔性装配方法，其特征在于，所述步骤(4)中，工控机控制两自由度调节装置实现第一待装配零件夹持状态的稳定，包括：

当工控机检测到第一外环测力传感器的力信号时，此时外环处于沿X轴正方向绕X轴向左偏摆的状态，工控机控制两自由度旋转平台沿X轴正方向绕X轴向右偏摆；当工控机检测到第一外环测力传感器的力信号小于一定阈值时，外环与第一外环测力传感器处于脱离接触状态或者不受力状态；

当工控机检测到第二外环测力传感器的力信号时，外环处于沿X轴正方向绕X轴向右偏摆的状态，工控机控制两自由度旋转平台沿X轴正方向绕X轴向左偏摆；当工控机检测到第二外环测力传感器的力信号小于一定阈值时，此时外环与第二外环测力传感器处于脱离接触状态或者不受力状态；

当工控机检测到第一内环测力传感器的力信号时，内环处于沿Y轴正方向绕Y轴向左偏摆的状态，工控机控制两自由度旋转平台沿Y轴正方向绕Y轴向右偏摆；当工控机检测到第一内环测力传感器的力信号小于一定阈值时，此时内环与第一内环测力传感器处于脱离接触状态或者不受力状态；

当工控机检测到第二内环测力传感器的力信号时，内环处于沿Y轴正方向绕Y轴向右偏摆的状态，工控机控制两自由度旋转平台沿Y轴正方向绕Y轴向左偏摆；当工控机检测到第二内环测力传感器的力信号小于一定阈值时，此时内环与第二内环测力传感器处于脱离接触状态或者不受力状态；

当外环与第一外环测力传感器、第二外环测力传感器均处于脱离接触状态或者不受力状态时，此时外环、第一外环测力传感器、第二外环测力传感器均处于稳定状态，外环调节完毕；

当内环与第一内环测力传感器、第二内环测力传感器均处于脱离接触状态或者不受力状态时，此时内环、第一内环测力传感器、第二内环测力传感器均处于稳定状态，内环调节完毕；

当外环和内环均调节完毕，此时夹持的第一待装配零件调节完毕，处于稳定状态。

Images