三自由度纳米机器人操作系统动力学建模方法及系统技术方案

本发明专利技术公开了一种三自由度纳米机器人操作系统动力学建模方法，包括：S1、获取三自由度纳米机器人的各个连杆的实际运动方向和全局坐标系的偏差角，建立纳米操作机器人连杆坐标系，获取纳米操作机器人的DH参数；S2、构建各个连杆和基座之间的坐标变换矩阵；S3、根据第二类拉格朗日函数建立三自由度纳米机器人操作单元的动力学模型，得到三轴纳米操作机器人关节广义驱动力。本发明专利技术建立的模型可以用来预测纳米操作机器人的运动轨迹，根据当前运动状态和目标轨迹调整电压输入，以达到减少跟踪误差，提高控制性能的效果。建立的模型可以用来估计运动过程中机器人对被操作物体的输出力，通过调整末端输出力，提升微纳操作的成功率。提升微纳操作的成功率。提升微纳操作的成功率。

【技术实现步骤摘要】
三自由度纳米机器人操作系统动力学建模方法及系统


[0001]本专利技术涉及纳米机器人控制
，特别涉及一种三自由度纳米机器人 操作系统动力学建模方法及系统。

技术介绍

[0002]常规的搭建在SEM内的纳米机器人操作系统由四个纳米操作机器人单元 组成，可以执行对各种微小尺度物体如碳纳米管的拔取、搬运、切割、放置等 操作。为了满足微纳操作的要求，每个纳米操作机器人都由三个压电陶瓷致动 器组合而成。关节驱动源为压电陶瓷晶体，在逆压电效应下将电信号转换为机 械运动。与传统的电机相比，压电陶瓷致动器具有分辨率高、带宽大、温度稳 定性好等优点。
[0003]使用纳米机器人操作系统各种进行微纳的一个关键要求是控制一个或多个 纳米操作机器人在同一坐标系下的运动轨迹，即同步控制各个压电陶瓷驱动关 节的运动。然而，压电陶瓷固有的迟滞非线性和系统动力学使其成为一项非常 具有挑战性的任务。为了克服这些问题，需要对由多个压电陶瓷致动器组成的 纳米机器人操作系统进行建模。常见的机器人动力学建模方法有拉格朗日方法 和牛顿欧拉法等，并且也有针对压电陶瓷致动器的动本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.三自由度纳米机器人操作系统动力学建模方法，其特征在于，包括：S1、对三自由度纳米操作机器人进行运动学分析，获取三自由度纳米机器人的各个连杆的实际运动方向和全局坐标系的偏差角，建立纳米操作机器人连杆坐标系，获取纳米操作机器人的DH参数；S2、基于纳米操作机器人的DH参数构建各个连杆和基座之间的坐标变换矩阵；S3、结合系统的动能、系统的势能、系统的耗散能，根据第二类拉格朗日函数建立三自由度纳米机器人操作单元的动力学模型，得到三轴纳米操作机器人关节广义驱动力。2.如权利要求1所述的三自由度纳米机器人操作系统动力学建模方法，其特征在于，所述三自由度纳米机器人的各个连杆的实际运动方向和全局坐标系的偏差角包括X轴偏差角α、Y轴偏差角β、Z轴偏差角在Y方向的分量θ、Z轴偏差角在X方向的分量γ。3.如权利要求2所述的三自由度纳米机器人操作系统动力学建模方法，其特征在于，步骤S2包括：构建基座坐标系与0坐标系的变换矩阵为：构建坐标系0与连杆一坐标系的变换矩阵为；连杆一坐标系相对于基座坐标系的变换矩阵为：又有：又有：连杆二坐标系相对于基座坐标系的变换矩阵为：连杆三坐标系相对于基座坐标系的变换矩阵为：
其中，d0为基座与0坐标系在Z方向的距离；d2为连杆二坐标系与连杆一坐标系在Z方向的距离；d3为连杆三坐标系与连杆二坐标系在Z方向的距离；q1、q2、q3为关节变量。4.如权利要求2所述的三自由度纳米机器人操作系统动力学建模方法，其特征在于，步骤S3中，三自由度纳米机器人操作单元的动力学模型，如下：其中，K为系统的动能；U为系统的势能；D为系统的耗散能；τ
′
为机器人关节广义驱动力；q为关节变量；t为时间。5.如权利要求4所述的三自由度纳米机器人操作系统动力学建模方法，其特征在于，机器人关节广义驱动力为：器人关节广义驱动力为：当末端执行器受到外部载荷F
ext
时，根据力雅可比矩阵，关节负...

【专利技术属性】
技术研发人员：杨湛，钱智毅，张略，孙立宁，
申请(专利权)人：苏州大学，
类型：发明
国别省市：