一种基于加速度传感器抑制并联平台振动控制系统及方法
【技术领域】
[0001] 本发明涉及3-RRR并联平台的控制，尤其涉及一种基于加速度传感器抑制并联平 台振动控制系统及方法。
【背景技术】
[0002] 并联机器人相比串联机器人具有尚速度、尚精度、尚承载能力的应用优势，并联机 器人的末端动平台可以实现高速运动、精确定位、承载大质量负载。选择并联机器人作为精 密定位平台，实现高速、高精度、高效率定位。并联机器人的各个主动关节协调运动使动平 台按期望轨迹运动。实际应用中并联平台存在多种非线性因素，减速器的间隙和摩擦、关节 间隙、杆件的弹性变形等，由于非线性因素的影响，并联机器人在运动过程中会产生振动， 3-RRR并联平台在奇异位形及附近定位时容易引发自激振动。
【发明内容】
[0003] 本发明的目的在于克服上述现有技术的缺点和不足，提供一种基于加速度传感器 抑制并联平台振动控制系统及方法，解决现有技术并联平台在运动过程中或定位时的振动 问题，使并联平台的运动或定位平稳、精准。
[0004] 本发明通过下述技术方案实现：
[0005] -种基于加速度传感器抑制并联平台振动控制系统，包括三个并联分支机构，每 个并联分支机构包括一台三相交流伺服电机1、减速器2、一根主动杆4、一根从动杆6 ;
[0006] 各个并联分支机构的三相交流伺服电机1分别安装在固定平台的三个安装孔里 面，安装孔呈等边三角形分布，三相交流伺服电机1连接减速器2,减速器2安装减速器转动 轴3,减速器转动轴3连接主动杆4,主动杆4的另一端通过主动杆转动轴5连接从动杆6， 从动杆6的另一端通过从动杆转动轴7连接动平台8,动平台8呈等边三角形；
[0007] 三个三相交流伺服电机1联合驱动主动杆4,主动杆4带动从动杆6使动平台8按 照期望轨迹运动；
[0008] 三相交流伺服电机1的端部安装增量式编码器，连接Dspace半物理仿真控制卡的 编码器信号接口，用于检测三相交流伺服电机1实际位置；
[0009] 动平台8上设有支架9,支架9上安装两个呈直线分布的三自由度加速度传感器， 即，第一三自由度加速度传感器11-1和第二三自由度加速度传感器11-2,用于检测动平台 8的两个平动自由度和一个转动自由度方向加速度；主动杆4上分别安装单自由度加速度 传感器，即，第一单自由度加速度传感器10-1、第二单自由度加速度传感器10-2和第三单 自由度加速度传感器10-3,用于检测主动杆4转动自由度方向加速度；
[0010] 所述三自由度加速度传感器和单自由度加速度传感器的输出端连接电荷放大器 的输入端，电荷放大器输出端连接Dspace半物理仿真控制卡的A/DC接口；三相交流伺服电 机1通过伺服驱动器与Dspace半物理仿真控制卡的I/O接口连接；
[0011] 所述单自由度加速度传感器安装在主动杆4、距离主动杆转动轴5轴心180_的中 心位置；
[0012] 所述第一三自由度加速度传感器11-1安装在动平台8的中心，第二三自由度加速 度传感器11-2安装在y轴正方向距离动平台8中心40mm的位置。
[0013] 所述三自由度加速度传感器和单自由度加速度传感器，均为压电式电荷输出型加 速度传感器；
[0014] 上述基于加速度传感器抑制并联平台振动控制系统的控制方法，其特征在于包括 如下步骤：
[0015] 步骤一：DspaCe半物理仿真控制卡发送控制信号给伺服驱动器驱动三相交流伺 服电机1，带动减速器2转动，通过主动杆4和被动杆6使动平台8按照预定轨迹运动；
[0016] 步骤二：三相交流伺服电机1端部安装的增量式编码器实时检测主动杆4的位置， 增量式编码器将信号经伺服驱动器分频后输入Dspace半物理仿真控制卡，将实际位置与 期望位置作差，偏差信号经过位置闭环控制算法产生控制信号，控制信号经过Dspace半物 理仿真控制卡的D/AC接口输出给伺服驱动器，驱动三相交流伺服电机1运动，使主动杆4 的运动跟随期望轨迹，进而使动平台8按期望轨迹运动；
[0017] 步骤三：在运动过程中或点定位时，由单自由度加速度传感器和三自由度加速度 传感器分别测试主动杆4和动平台8的加速度，加速度信息反映主动杆4和动平台8的振动 情况，将三相交流伺服电机1作为制动器抑制运动过程中的振动或点定位时的自激振动， 实现动平台8在运动过程中或点定位时的高精度。
[0018] 步骤三所述由单自由度加速度传感器和三自由度加速度传感器分别测试主动杆4 和动平台8的加速度，检测过程如下：
[0019] 动平台8的两个平动加速度值和一个转动角加速度值#通过以下公式计算得 到：
[0020] 安装在动平台8中心的第一三自由度加速度传感器11-1测得X方向加速度axl和 y方向加速度ayl，第二三自由度加速度传感器11-2测得X方向加速度ax2和y方向加速度 ay2，动平台中心点处的旋转角加速度为叫。 >2?
[0021] 本发明相对于现有技术，具有如下的优点及效果：
[0022] 本发明采用2个三自由度加速度传感器安装在动平台上，能够解算出动平台中心 2个平动自由度和1个转动自由度方向加速度，机构简单，质量轻，体积小，不影响并联平台 的特性，成本低。本发明可以检测3-RRR并联平台主动杆和动平台的加速度，结合增量式编 码器测量的主动关节角度，可以推导出3-RRR并联平台主动杆和动平台的实际位置、速度、 加速度。本发明采用增量式编码器和加速度传感器检测3-RRR并联平台主动杆和动平台的 位置、速度、加速度，这些信号经过解算作为控制信号给伺服驱动器，可以抑制运动过程中 的振动或点定位时的自激振动。
[0023] 本发明利用加速度传感器检测并联平台运动过程中的振动信号或点定位时的自 激振动信号，具有测量精度高，采样频率高，动态响应快的优点；
[0024] 本发明的基于加速度传感器的检测系统采用压电式电荷输出型加速度传感器能 够在高频带宽度范围内测量振动信息，可以准确分析振动量；
[0025] 综上所述，本发明的基于加速度传感器测量设备抑制并联平台振动的控制系统与 方法采用两个三自由度加速度传感器安装在动平台上，能够解算出动平台中心两个平动自 由度和一个转动自由度方向加速度，采用单自由度加速度传感器测量主动杆加速度，增量 式编码器测量主动关节的位置，这些信号可以解算出3-RRR并联平台主动杆和动平台的实 际位置、速度、加速度，进而定量分析并联平台在奇异位形及附近定位时的自激振动，分析 非线性因素如减速器的间隙和摩擦、杆件的弹性形变、关节的间隙等对并联平台动力学特 性的影响，进一步分析自激振动的机理；本发明的基于加速度传感器测量设备抑制并联平 台振动的控制系统与方法由单自由度加速度传感器测量的主动杆振动信息经过控制算法 给三相交流伺服电机施加控制信号，可以抑制并联平台运动过程中或点定位的振动，根据 三自由度加速度传感器测量的动平台振动信息，可以分析振动情况，评价抑制振动的控制 效果。
【附图说明】
[0026] 图1是本发明基于加速度传感器抑制并联平台振动控制系统的总体结构示意图；
[0027] 图2是图1的前视图；
[0028] 图3是图1的俯视图；
[0029] 图4是加速度传感器安装示意图；
[0030] 图5是图1动平台上的2个三自由度加速度传感器安装示意图；第一三自由度加 速度传感器安装在动平台的中心，第二三自由度加速度传感器安装在动平台的y轴方向， 呈直线分布。
[0031] 图6是图1主动杆上的单自由度加速度传感器安装示意图；
[0032] 图7是基于增量式编码器测量设备抑制并联平台振动控制过程方框图；将增量式 编码器的信号经过反相和滤波后作为控制信号给伺服驱动器，可以抑制自激振动。
[0033] 图8是基于加速度传感器测量设备抑制并联平台振动控制过程方框图；虚线框为 控制算法部分，在实际测试关节空间和工作空间的位置、速度、加速度后，可以按照机器人 动力学控制方法的思路设计控制算法抑制并联平台运动时的振动或点定位时的自激振动。
【具体实施方式】
[0034] 下面结合具体实施例对本发明作进一步具体详细描述。
[0035] 实施例
[0036] 如图1至8所示，并联平台控制是控制关节空间轨迹按照期望轨迹运动，进而使工 作空间轨迹按照期望轨迹运动。在三相交流伺服电机的位置控制模式下，由Dspace半物理 仿真控制卡的I/O口输出脉冲信号，脉冲快慢对应速度，脉冲数量对应位置，每个脉冲至少 需要两个采样周期完成，采样周期和电子齿数比决定了主动杆（主动关节）的速度和精度， 进而决定了动平台的速度和精度，伺服驱动器完成三环（电流环、速度环、位置环）的控制 算法，三相交流伺服电机的输出力矩由伺服驱动器计算输出；在三相交流伺服电机的力矩 控制模式下，Dspace半物理仿真控制卡通过D/AC端口输出模拟电压信号，伺服驱动器将该 信号转换为三相交流伺服电机的输出力矩，增量式编码器将电机位置信号反馈给