[0026] 进一步地，当医生拖拽所述末端执行器到达
指定的操作位置后，若需要进行钻孔操作，则按照如下方式进行处理：
[0027] 获取医生拖动所述末端执行器进行运动时的有效外力F在钻孔方向上的投影其中，钻孔方向的方向向量为 作用力为
[0028] 判断在钻孔方向上的有效外力 是否大于第二预设阈值Fs2，若是，则根据预设的第二V-F关系确定所述机器人在钻孔方向上的钻孔速度V2，并将所述钻孔速度V2发送给所述机器人控制器，以使所述机器人控制器控制所述机器人进行钻孔操作。
[0029] 第二方面，本发明还提供了一种基于力传感器的直接拖动示教方法，包括：
[0030] 实时获取在医生拖动末端执行器进行运动的过程中六维力传感器采集的末端执行器的受力信息；
[0031] 对所述六维力传感器采集的末端执行器的受力信息进行所述末端执行器本身的重力补偿，获取医生拖动所述末端执行器进行运动时的外力信息；
[0032] 根据获取的所述医生拖动所述末端执行器进行运动时的外力信息控制所述末端执行器进行运动。
[0033] 进一步地，所述对所述六维力传感器采集的末端执行器的受力信息进行所述末端执行器本身的重力补偿，获取医生拖动所述末端执行器进行运动时的外力信息，具体包括：
[0034] 获取预先存储的所述末端执行器在没有受到其他外力作用状况下其处于不同空间姿态时的多组第一测量数据；所述多组第一测量数据由所述六维力传感器采集得到；
[0035] 根据所述多组第一测量数据获取所述末端执行器质心在所述六维力传感器坐标系中的坐标(x，y，z)以及所述末端执行器重力G的大小；
[0036] 根据所述末端执行器质心在所述六维力传感器坐标系中的坐标(x，y，z)，所述末端执行器重力G的大小，以及所述六维力传感器采集的所述末端执行器的受力信息，利用下面公式一获取医生拖动所述末端执行器进行运动时外力在3个坐标轴上的分量：
[0037]
[0038] 以及，利用下面公式二获取医生拖动所述末端执行器进行运动时外力力矩在3个坐标轴上的分量：
[0039]
[0040] 其中，Fex、Fey、Fez是医生拖动所述末端执行器进行运动时外力在3个坐标轴上的分量；Mex、Mey、Mez是医生拖动所述末端执行器进行运动时外力力矩在3个坐标轴上的分量；Fx、Fy、Fz是医生拖动所述末端执行器进行运动的过程中所述六维力传感器采集的所述末端执行器在3个方向上的受力分量，Mx、My、Mz是医生拖动所述末端执行器进行运动的过程中所述六维力传感器采集的所述末端执行器在3个方向上的力矩分量；Gx、Gy、Gz是所述六维力传感器采集的力分量Fx、Fy、Fz中由于所述末端执行器重力产生的部分，Mgx、Mgy、Mgz是所述六维力传感器采集的力矩分量Mx、My、Mz中由于所述末端执行器重力产生的部分；
[0041] 其中，上述Gx、Gy、Gz采用下面公式三获取：
[0042]
[0043] 其中，上述Mgx、Mgy、Mgz采用下面公式四获取：
[0044]
[0045] 其中，所述α、β、γ为在对所述末端执行器安装姿态标定后实时获取到重力方向与六维力传感器坐标系X、Y、Z轴间的夹角。
[0046] 进一步地，所述根据获取的所述医生拖动所述末端执行器进行运动时的外力信息控制所述末端执行器进行运动，包括：
[0047] 根据医生拖动所述末端执行器进行运动时外力在3个坐标轴上的分量Fex、Fey和Fez判断有效外力F＝(Fex2、Fey2、Fez2)1/2是否大于第一预设阈值Fs1，若是，则根据预设的第一V-F关系确定用于带动所述末端执行器运动的机器人的运动线速度V1，并根据所述线速度V1确定所述机器人在X、Y、Z轴的分速度V1x、V1y、V1z，然后将所述机器人在X、Y、Z轴的分速度V1x、V1y、V1z发送给与所述机器人对应的机器人控制器，以使所述机器人控制器控制所述机器人带动所述末端执行器进行运动。
[0048] 第三方面，本发明还提供了一种
电子设备，包括
存储器、处理器及存储在存储器上并可在处理器上运行的
计算机程序，所述处理器执行所述程序时实现如第二方面所述基于力传感器的直接拖动示教方法的步骤。
[0049] 第四方面，本发明还提供了一种计算机可读存储介质，其上存储有计算机程序，该计算机程序被处理器执行时实现如第二方面所述基于力传感器的直接拖动示教方法的步骤。
[0050] 由上述技术方案可知，本发明提供的基于力传感器的直接拖动示教系统，包括：工控机、机器人控制器、机器人、六维力传感器和末端执行器；所述六维力传感器设置在所述机器人与所述末端执行器之间，用于在医生拖动所述末端执行器进行运动的过程中采集所述末端执行器的受力信息；所述工控机对所述六维力传感器采集的所述末端执行器的受力信息进行所述末端执行器本身的重力补偿，获取医生拖动所述末端执行器进行运动时的外力信息；所述工控机根据医生拖动所述末端执行器进行运动时的外力信息生成机器人运动指令，并将生成的机器人运动指令发送至所述机器人控制器，以使所述机器人控制器控制所述机器人进行运动。本发明在机器人末端加装多维力传感器传达医生的示教意图，引导机器人运动，并通过重力补偿，消除末端执行器重力的影响，故可较为准确地
感知医生手部作用力信息，实现自动准确的拖动示教。
附图说明
[0051] 为了更清楚地说明本发明
实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
[0052] 图1是本发明一实施例提供的基于力传感器的直接拖动示教系统的结构示意图；
[0053] 图2是本发明一实施例提供的基于力传感器的直接拖动示教系统的工作原理示意图；
[0054] 图3是六维力传感器坐标系示意图；
[0055] 图4是机器人柔性随动控制原理图；
[0056] 图5是工控机根据医生拖动所述末端执行器进行运动时的外力信息控制机器人进行运动的过程示意图；
[0057] 图6是预设的第一V-F关系示意图；
[0058] 图7是外力在钻孔方向上的投影示意图；
[0059] 图8是本发明另一实施例提供的基于力传感器的直接拖动示教方法的
流程图；
[0060] 图9是本发明又一实施例提供的电子设备的结构示意图。
具体实施方式
[0061] 为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整的描述，显然，所描述的实施例是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
[0062] 本发明一实施例提供了一基于力传感器的直接拖动示教系统，参见图1，该系统包括：工控机1、机器人控制器2、机器人3、六维力传感器4和末端执行器5；
[0063] 所述六维力传感器4安装在所述机器人2与所述末端执行器5之间，用于在医生拖动所述末端执行器5进行运动的过程中采集所述末端执行器5的受力信息；
[0064] 所述工控机1对所述六维力传感器4采集的所述末端执行器5的受力信息进行所述末端执行器5本身的重力补偿，获取医生拖动所述末端执行器5进行运动时的外力信息；
[0065] 所述工控机1根据医生拖动所述末端执行器5进行运动时的外力信息生成机器人运动指令，并将生成的机器人运动指令发送至所述机器人控制器2，以使所述机器人控制器2控制所述机器人3进行运动。
[0066] 参见图1，在该系统中，工控机1对六维力传感器4的
信号进行采集与处理，根据检测到的外力大小和方向生成机器人运动指令，发送至机器人控制器2中，控制机器人3运动。六维力传感器4可以通过
法兰和
螺纹连接在机器人3和末端执行器5之间，通过重力补偿算法消除末端执行器重力的影响后，可感知医生手部作用力信息。可以理解的是，在图1中，末端执行器(末端执行器5)重力作用在六维力传感器上，要想准确得到末端执行器(末端执行器5)受到的外部作用力信息，如医生手部作用力等，需要对末端执行器(末端执行器5)重力的影响进行补偿。可以理解的是，当该系统应用于
牙齿种植手术时，所述末端执行器5可以为口腔种植机。当该系统应用于其他场景如骨科或心脑手术时，所述末端执行器5可以为其他相配套的执行终端。
[0067] 图2示出了基于力传感器的直接拖动示教系统的工作原理示意图。由图2可知，本实施例通过在机器人末端加装六维力传感器的方式来达到传达医生示教意图的目的，根据六维力传感器采集的末端执行器的受力情况引导机器人进行运动，并通过重力补偿，消除末端执行器重力的影响，故可较为准确地感知医生的外部用力信息，实现自动准确的拖动示教。
[0068] 由上面描述可知，本实施例提供的基于力传感器的直接拖动示教系统，包括：工控机、机器人控制器、机器人、六维力传感器和末端执行器；所述六维力传感器设置在所述机器人与所述末端执行器之间，用于在医生拖动所述末端执行器进行运动的过程中采集所述末端执行器的受力信息；所述工控机对所述六维力传感器采集的所述末端执行器的受力信息进行所述末端执行器本身的重力补偿，获取医生拖动所述末端执行器进行运动时的外力信息；所述工控机根据医生拖动所述末端执行器进行运动时的外力信息生成机器人运动指令，并将生成的机器人运动指令发送至所述机器人控制器，以使所述机器人控制器控制所述机器人进行运动。本实施例在机器人末端加装多维力传感器传达医生的示教意图，引导机器人运动，并通过重力补偿，消除末端执行器重力的影响，故可较为准确地感知医生手部作用力信息，实现自动准确的拖动示教。
[0069] 在一种优选实施方式中，给出了进行重力补偿一种具体实施手段。参见下面介绍可知，所述工控机对所述六维力传感器采集的所述末端执行器的受力信息进行所述末端执行器本身的重力补偿，获取医生拖动所述末端执行器进行运动时的外力信息，具体包括：
[0070] a、获取预先存储的所述末端执行器在没有受到其他外力作用状况下其处于不同空间姿态时的多组第一测量数据；所述多组第一测量数据由所述六维力传感器采集得到；
[0071] b、根据所述多组第一测量数据获取所述末端执行器质心在所述六维力传感器坐标系中的坐标(x，y，z)以及所述末端执行器重力G的大小；
[0072] 参见图3，可以理解的是，若没有其他外力作用在末端执行器上，则六维力传感器测得的力与力矩信息完全由末端执行器重力引起。这种情况下，本实施例控制机器人使末端执行器(末端执行器)处于不同的空间姿态，得到多组六维力传感器的测量数据，然后再利用最小二乘法求解末端执行器质心在六维力传感器坐标系中的坐标(x，y，z)以及末端执行器重力G的大小。需要说明的是，测量多组数据，并根据多组测量数据采用最小二乘法进行计算处理，相对于只测一组数据进行求解的方法来说，可以尽量减少测量误差，使得计算结果的准确度提高。
[0073] c、根据所述末端执行器质心在所述六维力传感器坐标系中的坐标(x，y，z)，所述末端执行器重力G的大小，以及所述六维力传感器采集的所述末端执行器的受力信息，利用下面公式一获取医生拖动所述末端执行器进行运动时外力在3个坐标轴上的分量：
[0074]
[0075] 以及，利用下面公式二获取医生拖动所述末端执行器进行运动时外力力矩在3个坐标轴上的分量：
[0076]
[0077] 其中，Fex、Fey、Fez是医生拖动所述末端执行器进行运动时外力在3个坐标轴上的分量；Mex、Mey、Mez是医生拖动所述末端执行器进行运动时外力力矩在3个坐标轴上的分量；Fx、Fy、Fz是医生拖动所述末端执行器进行运动的过程中所述六维力传感器采集的所述末端执行器在3个方向上的受力分量(也即Fx、Fy、Fz是在有外力作用于末端执行器的情况下，六维力传感器测得的3个力分量)，Mx、My、Mz是医生拖动所述末端执行器进行运动的过程中所述六维力传感器采集的所述末端执行器在3个方向上的力矩分量(也即Mx、My、Mz是在有外力作用于末端执行器的情况下，六维力传感器测得的3个力矩分量)；Gx、Gy、Gz是所述六维力传感器采集的力分量Fx、Fy、Fz中由于所述末端执行器重力产生的部分，Mgx、Mgy、Mgz是所述六维力传感器采集的力矩分量Mx、My、Mz中由于所述末端执行器重力产生的部分；
[0078] 其中，上述Gx、Gy、Gz采用下面公式三获取：
[0079]
[0080] 其中，在手术操作中末端执行器重力在六维力传感器坐标系中的方向随机器人末端姿态变化而改变。对末端执行器安装姿态标定后可通过
机器人控制系统实时获取到重力方向与六维力传感器坐标系X、Y、Z轴间的夹角α、β、γ。
[0081] 其中，末端执行器重力G对X、Y、Z轴的作用力矩分别为Mgx、Mgy、Mgz，根据力与力矩的关系，参照图3可知Mgx、Mgy、Mgz可根据下面公式四获取：
[0082]
[0083] 可以理解的是，为了实现医生手持末端就能用很小的力拖动
机械臂随动，需要根据力传感器获得的人手作用力信息制定控制策略控制机器人产生柔性随动效果。末端执行器按人手作用力的方向运动，运动速度与人手作用力的大小相关。因此，在一种优选实施方式中，所述工控机根据医生拖动所述末端执行器进行运动时的外力信息生成机器人运动指令，并将生成的机器人运动指令发送至所述机器人控制器，以使所述机器人控制器控制所述机器人进行运动，具体包括：
[0084] 参见图4和图5，所述工控机根据医生(图5中用人
手表示)拖动所述末端执行器进行运动时外力在3个坐标轴上的分量Fex、Fey和Fez判断有效外力F＝(Fex2、Fey2、Fez2)1/2是否大于第一预设阈值Fs1，若是，则根据预设的第一V-F关系确定所述机器人的运动线速度V1，并根据所述线速度V1确定所述机器人在X、Y、Z轴的分速度V1x、V1y、V1z，然后将所述机器人在X、Y、Z轴的分速度V1x、V1y、V1z发送给所述机器人控制器，以使所述机器人控制器控制所述机器人(图5中以机械臂代替机器人)进行运动；否则，不控制所述机器人进行运动。
[0085] 可以理解的是，系统获得的外部作用力为控制输入，由于传感器自身误差或者重力补偿误差，在实际没有外力作用至传感器或末端执行器上的情况下，系统得到的外部作用力并不为0，因此为保证安全性，需要为系统获得的外部作用力大小F设定第一预设阈值Fs1，当F>Fs1时方能对机器人产生作用。其中，第一预设阈值Fs1的值可以根据实际需要进行设定。
[0086] 在一种优选实施方式中，所述预设的第一V-F关系为：当Fs1
[0087] 可以理解的是，所述预设的第一V-F关系表示的是机器人运动速度大小V与外部作用力大小F的关系。参见图6，当Fs1
[0088] 在一种优选实施方式中，当医生拖拽所述末端执行器到达指定的操作位置后，若需要进行钻孔操作，则按照如下方式进行处理：
[0089] A、获取医生拖动所述末端执行器进行运动时的有效外力F在钻孔方向上的投影其中，钻孔方向的方向向量为 作用力为
[0090] B、判断在钻孔方向上的有效外力 是否大于第二预设阈值Fs2，若是，则根据预设的第二V-F关系确定所述机器人在钻孔方向上的钻孔速度V2，并将所述钻孔速度V2发送给所述机器人控制器，以使所述机器人控制器控制所述机器人进行钻孔操作。
[0091] 可以理解的是，所述预设的第二V-F关系可以与所述第一V-F关系相同或类似，例如在某个区间范围内呈线性关系，在另一区间范围内成稳定恒值关系。其中，第二预设阈值Fs2的值可以根据实际需要进行设定。
[0092] 可以理解的是，医生拖拽机器人到达了指定的操作位置，接下来要进行钻孔时也可以根据力传感器信息来进行钻孔路径约束。如图7所示粗虚线为钻孔方向，设其方向向量为 作用力为 则外作用力在钻孔方向上的投影为 将操作外力F投影到钻孔方向上之后，再按照之前的控制流程，机器人就只能沿着规定好的方向进行运动。这样就能避免医生手抖动带来的误操作，增强手术的安全性与可靠性。
[0093] 基于相同的发明构思，本发明另一实施例提供了一种基于力传感器的直接拖动示教方法，参见图8，该方法包括如下步骤：
[0094] 步骤101：实时获取在医生拖动末端执行器进行运动的过程中六维力传感器采集的末端执行器的受力信息。
[0095] 步骤102：对所述六维力传感器采集的末端执行器的受力信息进行所述末端执行器本身的重力补偿，获取医生拖动所述末端执行器进行运动时的外力信息。
[0096] 步骤103：根据获取的所述医生拖动所述末端执行器进行运动时的外力信息控制所述末端执行器进行运动。
[0097] 在一种优选实施方式中，上述步骤102具体采用如下方式实现：
[0098] 获取预先存储的所述末端执行器在没有受到其他外力作用状况下其处于不同空间姿态时的多组第一测量数据；所述多组第一测量数据由所述六维力传感器采集得到；
[0099] 根据所述多组第一测量数据获取所述末端执行器质心在所述六维力传感器坐标系中的坐标(x，y，z)以及所述末端执行器重力G的大小；
[0100] 根据所述末端执行器质心在所述六维力传感器坐标系中的坐标(x，y，z)，所述末端执行器重力G的大小，以及所述六维力传感器采集的所述末端执行器的受力信息，利用下面公式一获取医生拖动所述末端执行器进行运动时外力在3个坐标轴上的分量：
[0101]
[0102] 以及，利用下面公式二获取医生拖动所述末端执行器进行运动时外力力矩在3个坐标轴上的分量：
[0103]
[0104] 其中，Fex、Fey、Fez是医生拖动所述末端执行器进行运动时外力在3个坐标轴上的分量；Mex、Mey、Mez是医生拖动所述末端执行器进行运动时外力力矩在3个坐标轴上的分量；Fx、Fy、Fz是医生拖动所述末端执行器进行运动的过程中所述六维力传感器采集的所述末端执行器在3个方向上的受力分量，Mx、My、Mz是医生拖动所述末端执行器进行运动的过程中所述六维力传感器采集的所述末端执行器在3个方向上的力矩分量；Gx、Gy、Gz是所述六维力传感器采集的力分量Fx、Fy、Fz中由于所述末端执行器重力产生的部分，Mgx、Mgy、Mgz是所述六维力传感器采集的力矩分量Mx、My、Mz中由于所述末端执行器重力产生的部分；
[0105] 其中，上述Gx、Gy、Gz采用下面公式三获取：
[0106]
[0107] 其中，上述Mgx、Mgy、Mgz采用下面公式四获取：
[0108]
[0109] 其中，所述α、β、γ为在对所述末端执行器安装姿态标定后实时获取到重力方向与六维力传感器坐标系X、Y、Z轴间的夹角。
[0110] 在一种优选实施方式中，上述步骤103具体采用如下方式实现：
[0111] 根据医生拖动所述末端执行器进行运动时外力在3个坐标轴上的分量Fex、Fey和Fez判断有效外力F＝(Fex2、Fey2、Fez2)1/2是否大于第一预设阈值Fs1，若是，则根据预设的第一V-F关系确定用于带动所述末端执行器运动的机器人的运动线速度V1，并根据所述线速度V1确定所述机器人在X、Y、Z轴的分速度V1x、V1y、V1z，然后将所述机器人在X、Y、Z轴的分速度V1x、V1y、V1z发送给与所述机器人对应的机器人控制器，以使所述机器人控制器控制所述机器人带动所述末端执行器进行运动。
[0112] 需要说明的是，本发明实施例提供的基于力传感器的直接拖动示教方法可以单独实现，也可以基于上述实施例所述的系统实现，本发明对此不做限定。
[0113] 基于相同的发明构思，本发明又一实施例提供了一种电子设备，参见图9，所述电子设备具体包括如下内容：处理器701、存储器702、通信
接口703和总线704；
[0114] 其中，所述处理器701、存储器702、
通信接口703通过所述总线704完成相互间的通信；所述通信接口703用于实现各建模
软件及智能制造装备模
块库等相关设备之间的信息传输；
[0115] 所述处理器701用于调用所述存储器702中的计算机程序，所述处理器执行所述计算机程序时实现上述实施例所述的基于力传感器的直接拖动示教方法中的全部步骤，例如，所述处理器执行所述计算机程序时实现下述步骤：
[0116] 步骤101：实时获取在医生拖动末端执行器进行运动的过程中六维力传感器采集的末端执行器的受力信息。
[0117] 步骤102：对所述六维力传感器采集的末端执行器的受力信息进行所述末端执行器本身的重力补偿，获取医生拖动所述末端执行器进行运动时的外力信息。
[0118] 步骤103：根据获取的所述医生拖动所述末端执行器进行运动时的外力信息控制所述末端执行器进行运动。
[0119] 基于相同的发明构思，本发明又一实施例提供了一种计算机可读存储介质，该计算机可读存储介质上存储有计算机程序，该计算机程序被处理器执行时实现上述实施例所述的基于力传感器的直接拖动示教方法中的全部步骤，例如，所述处理器执行所述计算机程序时实现下述步骤：
[0120] 步骤101：实时获取在医生拖动末端执行器进行运动的过程中六维力传感器采集的末端执行器的受力信息。
[0121] 步骤102：对所述六维力传感器采集的末端执行器的受力信息进行所述末端执行器本身的重力补偿，获取医生拖动所述末端执行器进行运动时的外力信息。
[0122] 步骤103：根据获取的所述医生拖动所述末端执行器进行运动时的外力信息控制所述末端执行器进行运动。
[0123] 需要说明的是，在本文中，诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来，而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下，由语句“包括一个……”限定的要素，并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
[0124] 以上实施例仅用于说明本发明的技术方案，而非对其限制；尽管参照前述实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行
修改，或者对其中部分技术特征进行等同替换；而这些修改或替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
