机器人及其柔性控制方法与装置
专利汇可以提供机器人及其柔性控制方法与装置专利检索，专利查询，专利分析的服务。并且本公开涉及一种 机器人 及其柔性控制方法与装置，属于机器人领域，既能够实现服务机器人的柔性要求，又能够提高机器人的控制 精度 。一种机器人柔性控制方法，包括：基于 机器人关节 的期望 角 度、期望 角速度 、期望角 加速 度，计算所述关节的期望 力 矩；在所述关节的实际力矩与所述期望力矩的差值的绝对值大于预设 阈值 的情况下，利用 弹簧 质量 阻尼模型，基于所述期望角度、所述期望角速度、所述期望 角加速度 、所述关节的实际角度、所述关节的实际角速度，控制所述关节的实际额外角加速度；基于所述实际额外角加速度和所述期望角度，控制所述关节的实际角度轨迹。，下面是机器人及其柔性控制方法与装置专利的具体信息内容。
1.一种机器人柔性控制方法，其特征在于，包括：
基于机器人关节的期望角度、期望角速度、期望角加速度，计算所述关节的期望力矩；
在所述关节的实际力矩与所述期望力矩的差值的绝对值大于预设阈值的情况下，利用弹簧质量阻尼模型，基于所述期望角度、所述期望角速度、所述期望角加速度、所述关节的实际角度、所述关节的实际角速度，控制所述关节的实际额外角加速度；
基于所述实际额外角加速度和所述期望角度，控制所述关节的实际角度轨迹。
2.根据权利要求1所述的方法，其特征在于，所述基于机器人关节的期望角度、期望角速度、期望角加速度，计算所述关节的期望力矩，通过以下公式来实现：
τ＝D(q)q″+H(q,q′)+G(q)+τf
其中，τ表示所述期望力矩；q表示所述期望角度；q′表示所述期望角速度；q″表示所述期望角加速度；τf表示摩擦力矩；D(q)是n×n的正定对称矩阵，是q的函数；H(q,q′)是n×1离心力和科氏力；G(q)是n×1重力矢量。
3.根据权利要求1所述的方法，其特征在于，所述利用弹簧质量阻尼模型，基于所述期望角度、所述期望角速度、所述期望角加速度、所述关节的实际角度、所述关节的实际角速度，控制所述关节的实际额外角加速度通过以下公式来实现：
q额外″＝(Δτ-K(qa-q)-D(qa′-q′))/M+q″
其中，在所述关节的实际力矩τ′大于所述期望力矩τ与所述预设阈值δτ之和时，Δτ＝τ′-(τ+δτ)，在所述关节的实际力矩τ′小于所述期望力矩τ与所述预设阈值δτ之差时，Δτ＝τ′-(τ-δτ)；q表示所述期望角度；q′表示所述期望角速度；q″表示所述期望角加速度；qa表示所述关节的实际角度；qa′表示所述关节的实际角速度，q额外″表示所述关节的实际额外角加速度；K表示刚性系数；D表示微分系数；M表示积分系数。
4.根据权利要求1所述的方法，其特征在于，所述基于所述实际额外角加速度和所述期望角度，控制所述关节的实际角度轨迹，通过以下公式来实现：
qa＝q+∫∫q额外″
其中，qa表示所述关节的实际角度；q表示所述期望角度；q额外″表示所述关节的实际额外角加速度。
5.根据权利要求1至4中任一权利要求所述的方法，其特征在于，所述方法还包括：
在所述关节的实际力矩与所述期望力矩的差值的绝对值变为小于所述预设阈值的情况下，基于所述期望角度、所述期望角速度、所述期望角加速度、所述关节的实际角度、所述关节的实际角速度、所述关节的实际角加速度，将所述关节的实际角度逐步调整回到所述期望角度。
6.根据权利要求5所述的方法，其特征在于，所述关节的实际角度的调整步长通过以下公式来确定：
Δq＝K(q-qa)+D(q′-qa′)+M(q″-qa″)
其中，Δq表示所述关节的实际角度的调整步长；q表示所述期望角度；q′表示所述期望角速度；q″表示所述期望角加速度；qa表示所述关节的实际角度；qa′表示所述关节的实际角速度，qa″表示所述关节的实际角加速度；K表示刚性系数；D表示微分系数；M表示积分系数。
7.一种机器人柔性控制装置，其特征在于，包括：
期望力矩计算模块，用于基于机器人关节的期望角度、期望角速度、期望角加速度，计算所述关节的期望力矩；
实际额外角加速度控制模块，用于在所述关节的实际力矩与所述期望力矩的差值的绝对值大于预设阈值的情况下，利用弹簧质量阻尼模型，基于所述期望角度、所述期望角速度、所述期望角加速度、所述关节的实际角度、所述关节的实际角速度，控制所述关节的实际额外角加速度；
实际角度轨迹控制模块，用于基于所述实际额外角加速度和所述期望角度，控制所述关节的实际角度轨迹。
8.根据权利要求7所述的装置，其特征在于，所述装置还包括：
回调模块，用于在所述关节的实际力矩与所述期望力矩的差值的绝对值变为小于所述预设阈值的情况下，基于所述期望角度、所述期望角速度、所述期望角加速度、所述关节的实际角度、所述关节的实际角速度、所述关节的实际角加速度，将所述关节的实际角度逐步调整回到所述期望角度。
9.根据权利要求8所述的装置，其特征在于，所述关节的实际角度的调整步长通过以下公式来确定：
Δq＝K(q-qa)+D(q′-qa′)+M(q″-qa″)
其中，Δq表示所述关节的实际角度的调整步长；q表示所述期望角度；q′表示所述期望角速度；q″表示所述期望角加速度；qa表示所述关节的实际角度；qa′表示所述关节的实际角速度，qa″表示所述关节的实际角加速度；K表示刚性系数；D表示微分系数；M表示积分系数。
10.一种机器人，其特征在于，所述机器人包括根据权利要求7至9中任一权利要求所述的机器人柔性控制装置。
机器人及其柔性控制方法与装置
技术领域
背景技术
具体实施方式
| 标题 | 发布/更新时间 | 阅读量 |
|---|---|---|
| 一种降低机器人运动能耗的工位布局方法 | 2020-05-08 | 389 |
| 一种工业机器人前馈力矩实时计算方法 | 2020-05-08 | 538 |
| 一种直驱式类人双足机器人 | 2020-05-12 | 871 |
| 四足机器人在负载突变下基于ZMP理论的反应式鲁棒控制方法 | 2020-05-08 | 899 |
| 紧凑型机器人变刚度关节 | 2020-05-12 | 179 |
| IPMC曲线驱动器及基于IPMC与硅胶材料的柔性关节四足机器人单腿系统 | 2020-05-11 | 699 |
| 拟人机器人的小腿组件及拟人机器人 | 2020-05-11 | 423 |
| 机器人三四关节组合体 | 2020-05-11 | 252 |
| 拟人机器人的足部组件及拟人机器人 | 2020-05-11 | 828 |
| 一种下肢外骨骼机器人 | 2020-05-08 | 324 |
高效检索全球专利专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台，是提供专利分析，专利查询，专利检索等数据服务功能的知识产权数据服务商。
我们的产品包含105个国家的1.26亿组数据，免费查、免费专利分析。
专利汇分析报告产品可以对行业情报数据进行梳理分析，涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度，系统通过AI智能系统对图表进行解读，只需1分钟，一键生成行业专利分析报告。
