本实用新型涉及一种模块化机器人关节动力学参数辨识精度提高装置。
背景技术：
机器人在现在的生产、生活中扮演着越来越重要的角色，尤其通用性较强的模块化机器人。模块化机器人是一种以模块化关节、连杆及标准电气接口为基础，能够根据环境和任务需要自动或人为改变自身构型的机器人。由于模块化机器人构型可变等特点引起机器人不确定性增强，导致传统控制方法不满足目前机器人轨迹跟踪的要求，要提高机器人性能，需要建立考虑机器人精确关节动力学模型的方法，在此情况下，机器人关节参数辨识显得尤为重要，但目前现有的参数辨识方法与装置准确性较差。
现有参数辨识测量不精确的主要原因是：已有关节测量中一般采用电机内置编码器获得关节角度值，角速度与角加速值需要通过数学微分获得，这增加了噪声干扰与误差，部分机器人关节中安装有谐波减少器等装置，引入的柔性、间隙、迟滞等因素势必影响传统测量方式的精度。关节力矩值通常通过检测电机电流的间接方式获得，测量精度依赖电机性能，显然不准确。
上述问题是在模块化机器人关节动力学参数辨识过程中应当予以考虑并解决的问题。
技术实现要素：
本实用新型的目的是提供一种模块化机器人关节动力学参数辨识精度提高装置解决现有技术中存在的关节力矩值通常通过检测电机电流的间接方式获得，测量精度依赖电机性能，显然不准确，致使现有参数辨识测量不精确的问题。
本实用新型的技术解决方案是：
一种模块化机器人关节动力学参数辨识精度提高装置，包括控制单元、驱动单元、传感器单元、负载单元和平台固定单元，控制单元分别通过通讯总线连接驱动单元、传感器单元，驱动单元通过法兰连接负载单元，驱动单元、传感器单元与负载单元均固定在平台固定单元上，控制单元包括PC工控机和运动控制卡，运动控制卡通过卡槽与PC工控机连接，驱动单元包括驱动器、电机和谐波减速器，驱动器的一个接口通过通讯总线一与运动控制卡连接，驱动器的另一接口通过总线连接电机，电机与谐波减速器由可调法兰一和螺栓连接，传感器单元包括转速计、16位绝对式编码器、20位绝对式编码器和力矩传感器。
进一步地，力矩传感器的一侧通过螺栓与谐波减速器固连，力矩传感器的另一侧通过可调法兰二与负载单元连接，20位绝对式编码器的码盘通过螺栓与电机连接，20位编码器的读数头通过螺栓与平台固定单元固连，16位绝对式编码器的码盘通过螺栓与可调法兰二固连，力矩传感器通过可调法兰二与负载单元连接，16位编码器的读数头通过螺栓与平台固定单元固连，转速计的码盘通过螺栓与可调法兰二连接，转速计的读数头通过螺栓与平台固定单元固连，力矩传感器、20位绝对式编码器的读数头、16位绝对式编码器的读数头、转速计的读数头均通过通讯总线二连接控制单元。
进一步地，负载单元采用铝质连杆或钢质连杆。
本实用新型的有益效果是：该种模块化机器人关节动力学参数辨识精度提高装置与方法，采用多传感融合技术，通过两个绝对式编码器分别直接实时测量关节端与电机端角度，绝对式编码器具有断电记忆功能，增强了装置的安全性。用转速计直接测量关节角速度，用力矩传感器直接实时测量关节力矩，直接测量的方式减少了控制单元的计算量，便于实现实时控制，且解决间接测量引起干扰与误差增大等问题，提高参数辨识精度。
附图说明
图1是本实用新型实施例模块化机器人关节动力学参数辨识精度提高装置的说明示意图；
图2是本实用新型实施例一模块化机器人关节动力学参数辨识精度提高方法的流程示意图；
其中：1-控制单元，2-PC工控机，3-运动控制卡，4-平台固定单元，5-驱动器，6-20位绝对式编码器的码盘，7-20位绝对式编码器的读数头，8-通讯总线一，9-通讯总线二，10-16位绝对式编码器的读数头，11-16位绝对式编码器的码盘，12-电机，13-可调法兰一，14-谐波减速器，15-力矩传感器，16-可调法兰二，17-转速计的读数头，18-转速计的码盘，19-负载单元。
具体实施方式
下面结合附图详细说明本实用新型的优选实施例。
一种模块化机器人关节动力学参数辨识精度提高装置，如图1，包括控制单元、驱动单元、传感器单元和负载单元，控制单元分别通过通讯总线连接驱动单元、传感器单元，驱动单元通过传感器单元连接负载单元，控制单元由PC工控机和运动控制卡组成，驱动单元由电机、驱动器和谐波减速器组成，传感器单元由转速计、16位绝对式编码器、20位绝对式编码器和力矩传感器组成。负载单元采用铝制连杆或钢制连杆。
该种模块化机器人关节动力学参数辨识精度提高装置，采用多传感融合技术，通过两个绝对式编码器分别直接实时测量关节端与电机端角度，绝对式编码器具有断电记忆功能，增强了装置的安全性。用转速计直接测量关节角速度，用力矩传感器直接实时测量关节力矩，直接测量的方式减少了控制单元的计算量，便于实现实时控制，且解决间接测量引起干扰与误差增大等问题，提高参数辨识精度。
实施例一
一种采用上述模块化机器人关节动力学参数辨识精度提高装置的模块化机器人关节动力学参数辨识精度提高方法，如图2，具体包括以下步骤，
S1、采用牛顿-欧拉法进行动力学建模。步骤S1具体包括：
S11、设定坐标系，根据牛顿—欧拉公式建立关节动力学模型：
式中，F表示质心上的力，m表示刚体质量，表示加速度，I表示刚体在坐标系中的惯性张量，ω表示刚体转动的角速度，表示刚体转动的角加速度。
S12、将上式推导化简得关节动力学方程一般等价形式：
S13、将上式线性化改写成如下形式：
式中，表示观测矩阵，是关于的多项式形式，x表示待辨识参数向量，待辨识参数x即能够辨识的“动力学参数，例如，机器人关节惯量参数，机器人关节负载质量参数等。
S2、将改进的傅里叶级数激励轨迹应用于模块化机器人关节动力学参数辨识精度提高装置；步骤S2中激励轨迹函数为：
其中，tf＝2π/ωf，j＝INT(t/tf)，q(0)＝qinit,q(tf)＝qinit,
式中，i表示第i关节数，t表示时间，m是整数，ωf表示基频，N表示谐波的个数，j表示第j个周期，INT(·)表示取整函数，表示系数，qinit表示初始关节角向量，表示初始关节角速度向量，一个周期结束，机器人关节回到初始位姿。
将激励轨迹在PC工控机上位机软件中以C语言的形式编写，以指令的形式传递给运动控制卡，运动控制卡通过通讯总线，发送命令给电机及驱动器。
S3、利用传感器单元采集角度值、角速度值与力矩值；步骤S3具体为，
20位绝对式编码器直接实时采集电机端角度，16位绝对式编码器直接测量关节负载端角度，转速计直接测量关节角速度，力矩值通过力矩传感器直接测量获得。上述数据通过通讯总线传递给控制单元，采用直接测量的方式，避免了由于噪声干扰等因素引起的误差，提高参数辨识准确性。
S4、通过转速计测量的角速度值进行微分得到角加速度值，初步预处理信息；步骤S4中，初步预处理信息，具体为，将采集数据通过通讯总线反馈回参数辨识装置控制单元，进行数据初步处理，对转速计测量的角速度量先进行滤波处理提高信噪比，然后进行微分处理获得关节角加速度值。将获得的关节值处理成观测矩阵Y的参变量形式。
S5、进行参数估计，将参变量带入动力学方程估算出动力学参数；步骤S5中，进行参数估计，具体为，将步骤S4所获参变量带入动力学方程估算出动力学参数：
根据变形可得：(YTY)-1YTτ＝x
将步骤S4中，由传感器测量经预处理得到的关节角度q，角速度角加速度值带入观测矩阵Y中，力矩传感器测量得到的τi值带入τ，采用加权最小二乘法得到参数辨识值x。
S6、实验验证，将获得的辨识参数带入动力学模型进行轨迹跟踪控制测试，通过跟踪误差验证辨识结果有效性，并根据结果不断优化辨识装置，也就是，在多次实验中，分析比较轨迹跟踪控制结果，找出影响轨迹跟踪控制结果的因素(如关节角度值或电机角度值等测量不准确)，根据具体情况，修正优化参数辨识装置使之获得准确角度值从而达到优化装置的目的，待轨迹跟踪测试达到设定要求，停止优化，得到最终的辨识参数。具体为：
分别在空载、安装铝制连杆、钢质连杆下重复上述步骤进行3组实验。通过Solidworks软件建立铝制连杆与钢质连杆几何模型，通过CAD法获得连杆的惯量参数与实验获得的辨识参数对比，为辨识结果提供理论支撑。将辨识结果带入动力学模型进行轨迹跟踪控制测试，通过跟踪误差验证辨识结果有效性，并根据结果不断优化辨识装置，待轨迹跟踪测试达到设定要求，停止优化，得到最终的辨识参数。
实施例采用牛顿-欧拉迭代公式建立动力学方程，计算量小，减少运行时间保证控制系统实时性。
实施例利用改进的傅里叶级数作为激励轨迹，解决了现有激励轨迹存在优化步骤复杂，效率低下的缺点，可以保证激励轨迹满足速度、加速度边界条件，提高采样数据信噪比从而提高参数测量精度。
实施例通过solidworks软件，采用CAD法获得负载连杆惯量参数，为辨识参数提供可靠的理论依据。
实施例用构型相同，材质不同的连杆作负载，可在几何参数不变，质量改变的情况下，分析比较不同负载质量情况下的参数辨识结果以充分验证辨识方法与装置的有效性。
实施例二
一种采用上述模块化机器人关节动力学参数辨识精度提高装置的模块化机器人关节动力学参数辨识精度提高方法，具体包括以下步骤，
S1、根据扭簧原理建立刚度辨识方程：
τ＝K·Δq＝K(q-q0)
其中，Δq表示扭转角变形量，q表示关节角度值，q0表示电机端角度值。
S2、将改进的傅里叶级数激励轨迹应用于模块化机器人关节动力学参数辨识精度提高装置；步骤S2中激励轨迹函数为：
其中，tf＝2π/ωf，j＝INT(t/tf)，q(0)＝qinit,q(tf)＝qinit,
式中，i表示第i关节数，t表示时间，m是整数，ωf表示基频，N表示谐波的个数，j表示第j个周期，INT(·)表示取整函数，表示系数，qinit表示初始关节角向量，表示初始关节角速度向量，一个周期结束，机器人关节回到初始位姿。
将激励轨迹在PC工控机上位机软件中以C语言的形式编写，以指令的形式传递给运动控制卡，运动控制卡通过通讯总线，发送命令给电机及驱动器。
S3、忽略间隙等因素影响，利用20位绝对式编码器直接实时采集电机端角度值q0，力矩传感器直接实时采集关节力矩值τi，关节端16位绝对式编码器直接实时采集关节角度值q。通过通讯总线传输给控制单元，根据公式τi＝K(q-q0)计算得到关节等效刚度系数K。
S4、在不同的钢质与铝质连杆负载条件下重复上述步骤，分别做5次实验取平均值，求得最终关节等效刚度系数K。