CN114019874B - 一种基于dsp的液压马达控制装置及方法 - Google Patents

一种基于dsp的液压马达控制装置及方法 Download PDF

Info

Publication number
CN114019874B
CN114019874B CN202111307946.9A CN202111307946A CN114019874B CN 114019874 B CN114019874 B CN 114019874B CN 202111307946 A CN202111307946 A CN 202111307946A CN 114019874 B CN114019874 B CN 114019874B
Authority
CN
China
Prior art keywords
compensator
hydraulic motor
input end
subtracter
speed
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202111307946.9A
Other languages
English (en)
Other versions
CN114019874A (zh
Inventor
贾云鑫
沈建文
尹文君
刘小建
田宇
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kunming Haiwei Dynamo Electric Technology Institute Ltd
Harbin Mingkuai Electromechanical Technology Co ltd
Original Assignee
Kunming Haiwei Dynamo Electric Technology Institute Ltd
Harbin Mingkuai Electromechanical Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Kunming Haiwei Dynamo Electric Technology Institute Ltd, Harbin Mingkuai Electromechanical Technology Co ltd filed Critical Kunming Haiwei Dynamo Electric Technology Institute Ltd
Priority to CN202111307946.9A priority Critical patent/CN114019874B/zh
Publication of CN114019874A publication Critical patent/CN114019874A/zh
Application granted granted Critical
Publication of CN114019874B publication Critical patent/CN114019874B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
    • G05B19/042—Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
    • G05B19/0423—Input/output
    • F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B15/00—Fluid-actuated devices for displacing a member from one position to another; Gearing associated therewith
    • F15B15/08—Characterised by the construction of the motor unit
    • F15B15/14—Characterised by the construction of the motor unit of the straight-cylinder type
    • F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B21/00—Common features of fluid actuator systems; Fluid-pressure actuator systems or details thereof, not covered by any other group of this subclass
    • F15B21/02—Servomotor systems with programme control derived from a store or timing device; Control devices therefor
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/20—Pc systems
    • G05B2219/25—Pc structure of the system
    • G05B2219/25257—Microcontroller

Abstract

一种基于DSP的液压马达控制装置及方法，涉及液压马达控制领域。本发明为解决了现有以计算机作为主控的液压马达控制方法，存在控制过程复杂、稳定性较差的问题。本发明基于DSP实现，DSP包括一阶前馈模块、二阶前馈模块、并联积分模块、位置补偿器、速度补偿器、加速度补偿器、压差补偿器模数转换器、状态观测器、1号减法器、1号加法器、2号减法器、3号减法器和4号减法器；通过本发明系统对角位置偏差、角速度偏差、角加速度偏差、以及采集的压差测量信号进行补偿，从而生成高精度的控制信号，从而提高对液压马达转轴的精确控制。本发明主要用于对电液伺服系统中的液压马达的转轴进行带前馈的多回路控制。

Description

一种基于DSP的液压马达控制装置及方法
技术领域
本发明涉及液压马达控制领域。
背景技术
液压马达是液压系统的一种执行元件，它将液压泵提供的液体压力能转变为其输出轴的机械能(转矩和转速)。液体是传递力和运动的介质。从能量转换的观点来看，液压泵与液压马达是可逆工作的液压元件，向任何一种液压泵输入工作液体，都可使其变成液压马达工况；反之，当液压马达的主轴由外力矩驱动旋转时，也可变为液压泵工况。因为它们具有同样的基本结构要素--密闭而又可以周期变化的容积和相应的配油机构。但是，由于液压马达和液压泵的工作条件不同，对它们的性能要求也不一样，所以同类型的液压马达和液压泵之间，仍存在许多差别。首先液压马达应能够正、反转，因而要求其内部结构对称；液压马达的转速范围需要足够大，特别对它的最低稳定转速有一定的要求。因此，它通常都采用滚动轴承或静压滑动轴承；其次液压马达由于在输入压力油条件下工作，因而不必具备自吸能力，但需要一定的初始密封性，才能提供必要的起动转矩。由于存在着这些差别，使得液压马达和液压泵在结构上比较相似，但不能可逆工作。主要应用于注塑机械、船舶、起扬机、工程机械、建筑机械、煤矿机械、矿山机械、冶金机械、船舶机械、石油化工、港口机械等。
当前，液压马达控制方法均采用计算机作为主控，通过计算机实现相关控制算法，并且所有控制相关的算法及方法均需要事前编程，控制前期工作量巨大，而且其控制实时性、稳定行较差，复杂度高；因此，以上问题亟需解决。
发明内容
本发明目的是为了解决现有以计算机作为主控的液压马达控制方法，存在控制过程复杂、稳定性较差的问题，本发明提供了一种基于DSP的液压马达控制装置及方法。
一种基于DSP的液压马达控制装置，该控制装置基于DSP实现，用于对电液伺服系统中的液压马达转轴进行驱动控制；DSP包括一阶前馈模块、二阶前馈模块、并联积分模块、位置补偿器、速度补偿器、加速度补偿器、压差补偿器、模数转换器、状态观测器、1号减法器、1号加法器、2号减法器、3号减法器和4号减法器；
一阶前馈模块的输入端用于接收液压马达转轴的给定角速度，一阶前馈模块的输出端与至1号加法器的第一加数输入端连接；
二阶前馈模块的输入端用于接收液压马达转轴的给定角加速度，一阶前馈模块的输出端与3号减法器的第一被减数输入端连接；
1号减法器的被减数输入端用于接收液压马达转轴的给定角位置，1号减法器的减数输入端用于接收液压马达转轴的测量角位置，1号减法器输出端与位置补偿器的输入端与并联积分模块的第一输入端连接；
位置补偿器的输出端与1号加法器的第二加数输入端连接，并联积分模块的输出端与1号加法器的第三加数输入端连接；
1号加法器的输出端与2号减法器的被减数输入端连接，2号减法器的减数输入端与状态观测器的角速度输出端连接，2号减法器的输出端与速度补偿器的输入端连接，速度补偿器的输出端与3号减法器的第二被减数输入端连接，3号减法器的减数输入端与状态观测器的角加速度输出端连接，3号减法器的输出端与加速度补偿器的输入端连接，加速度补偿器的输出端与4号减法器的被减数输入端连接，4号减法器的减数输入端用于接收液压马达的压力腔与回油腔的压差测量信号；
4号减法器的输出端与压差补偿器的输入端连接，压差补偿器的输出端与模数转换器的输入端连接，模数转换器的输出端输出的控制信号通过控制液压马达的电液伺服阀驱动液压马达转轴运动；
状态观测器的第一输入端用于接收模数转换器的输出端输出的控制信号，状态观测器的第二输入端用于接收液压马达转轴的测量角位置，且状态观测器用于根据接收的控制信号对液压马达转轴的测量角位置进行观测，生成的估计角速度和估计角加速度分别通过状态观测器的角速度输出端和角加速度输出端输出。
优选的是，液压马达的压力腔和回油腔的压差测量信号是通过压力传感器获取的。
优选的是，液压马达转轴的测量角位置是通过编码器测量获取。
优选的是，位置补偿器和速度补偿器均采用相位超前-滞后网络实现。
优选的是，速度补偿器所采用的相位超前-滞后网络的状态方程为：
Figure GDA0003813803820000021
其中，Uc(K)为K时刻速度补偿器输出的速度补偿控制量；
Uc(K-1)为K-1时刻速度补偿器输出的速度补偿控制量；
T0为时间常数；
Ts为采样周期；
H0为超前滞后因子；
K′为放大倍数；
ε(K)为K时刻速度补偿器所接收的2号减法器输出的差值结果；
ε(K-1)为K-1时刻速度补偿器所接收的2号减法器输出的差值结果。
优选的是，位置补偿器所采用的相位超前-滞后网络的状态方程为：
Figure GDA0003813803820000031
其中，US(K)为K时刻位置补偿器输出的角位置偏差补偿控制量；
US(K-1)为K-1时刻速位置补偿器输出的角位置偏差补偿控制量；
T0为时间常数；
Ts为采样周期；
H0为超前滞后因子；
K′为放大倍数；
ε′(K)为K时刻位置补偿器所接收的1号减法器输出的角位置偏差；
ε′(K-1)为K-1时刻位置补偿器所接收的1号减法器输出的角位置偏差。
优选的是，公式一中，
当H0＞1时，速度补偿器所采用的相位超前-滞后网络为超前网络；
当H0＝1时，速度补偿器所采用的相位超前-滞后网络为比例放大器；
当0＜H0＜1时，速度补偿器所采用的相位超前-滞后网络为滞后网络。
优选的是，公式二中，
当H0＞1时，位置补偿器所采用的相位超前-滞后网络为超前网络；
当H0＝1时，位置补偿器所采用的相位超前-滞后网络为比例放大器；
当0＜H0＜1时，位置补偿器所采用的相位超前-滞后网络为滞后网络。
优选的是，一阶前馈模块采用一阶前馈算法实现，二阶前馈模块采用二阶前馈算法实现。
采用所述的一种基于DSP的液压马达控制装置实现的控制方法，该控制方法包括如下过程：
步骤S1、一阶前馈模块对其接收的液压马达转轴的给定角速度进行补偿，并将给定角速度补偿结果送至1号加法器的第一加数输入端；
二阶前馈模块对其接收的液压马达转轴的给定角加速度进行补偿，并将给定角加速度补偿结果送至3号减法器的第一被减数输入端；
1号减法器接收的液压马达转轴的给定角位置与测量角位置作差后，获得的角位置偏差同时送至并联积分模块和位置补偿器，其中，并联积分模块用于对接收的角位置偏差进行积分后送至1号加法器的第三加数输入端，位置补偿器根据接收的角位置偏差生成角位置偏差补偿控制量，并将角位置偏差补偿控制量送至1号加法器的第二加数输入端，1号加法器对接收数据求和后，将其求和结果送至2号减法器的被减数输入端；
步骤S2、2号减法器的减数输入端接收状态观测器输出的估计角速度，3号减法器的减数输入端接收状态观测器输出的估计角加速度；
2号减法器对接收的数据求差，并将其差值结果送至速度补偿器，速度补偿器对接收的差值结果生成速度补偿控制量，并将速度补偿控制量送至3号减法器的第二被减数输入端；
3号减法器对接收的数据求差后，将其差值结果送至加速度补偿器，加速度补偿器对接收的差值结果进行加速度补偿，生成加速度补偿控制量，并将该加速度补偿控制量送至4号减法器；
4号减法器对接收的加速度补偿控制量与压差测量信号进行求差，获得压差偏差，并将该压差偏差送至压差补偿器，压差补偿器对接收的压差偏差进行补偿，并将生成的压差偏差补偿量送至模数转换器；
步骤S3、模数转换器将接收的压差偏差补偿量乘以预设增益后，再进行模数转换，并将模数转换后的结果作为控制信号控制液压马达的电液伺服阀驱动液压马达转轴运动，从而实现对液压马达转轴的控制。
本发明带来的有益效果是：本发明根据液压马达控制机理，提供了一种基于DSP的液压马达控制装置和方法，通过本发明方法，可简化液压马达的控制过程，通过本发明系统对角位置偏差、角速度偏差、角加速度偏差、以及采集的压差测量信号进行补偿从而生成高精度的控制信号，从而提高对液压马达转轴的精确控制，实现对液压马达转轴的精确跟踪及控制，提高对马达的控制精度和稳定性，本发明可满足市面上大多数电液伺服系统控制需求。通过DSP作为主控载体，采用C++语言对整体控制方法进行编程，同时集成控制相关算法；应用DSP采用开放式寄存器和参数调整算法，可满足不同控制精度的需求。
本发明主要用于对电液伺服系统中的液压马达的转轴进行带前馈的多回路控制。
采用本发明控制方法，对液压马达控制无需编程也无需大型计算机作为主控载体，在低精度控制方面可直接应用，高精度控制方面可自行调整控制参数，满足不同控制精度需求。提高控制稳定行、增加控制实时性。无需编程经验既可实现液压马达的精确控制。本发明还具有以下方面的优点：
应用简单：一种基于DSP的液压马达控制装置应用时，对液压马达控制过程简化，提高应用便捷性，只需设置相应参数后，即可轻松输出液压马达所需控制数据；
高实时性：高度优化的控制算法结合DSP嵌入式结构，保证强实时性能；
高智能性：具备专家参数调整能力，根据外部数据反馈情况，自行整定内部所需控制参数；
开放调试接口：DSP的所有内部参数寄存器都具备外部调整能力，针对高精度应用场合，可自行调整内部参数；
高稳定性：通过算法的不断优化及大量实际项目应用，本发明方法稳定性及佳；
调试测试一体化：调试模式与测试模式指令协议一致，调试完成后无需进行模式转换，直接可进行正式控制。
附图说明
图1是本发明所述一种基于DSP的液压马达控制装置的原理示意图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动的前提下所获得的所有其他实施例，都属于本发明保护的范围。
需要说明的是，在不冲突的情况下，本发明中的实施例及实施例中的特征可以相互组合。
实施例1：
参见图1说明本实施例所述的一种基于DSP的液压马达控制装置，该控制装置基于DSP实现，用于对电液伺服系统中的液压马达转轴进行驱动控制；DSP包括一阶前馈模块1、二阶前馈模块2、并联积分模块3、位置补偿器4、速度补偿器5、加速度补偿器6、压差补偿器7、模数转换器8、状态观测器9、1号减法器10、1号加法器11、2号减法器12、3号减法器13和4号减法器14；
一阶前馈模块1的输入端用于接收液压马达转轴的给定角速度，一阶前馈模块1的输出端与至1号加法器11的第一加数输入端连接；
二阶前馈模块2的输入端用于接收液压马达转轴的给定角加速度，一阶前馈模块1的输出端与3号减法器13的第一被减数输入端连接；
1号减法器10的被减数输入端用于接收液压马达转轴的给定角位置，1号减法器10的减数输入端用于接收液压马达转轴的测量角位置，1号减法器10输出端与位置补偿器4的输入端与并联积分模块3的第一输入端连接；
位置补偿器4的输出端与1号加法器11的第二加数输入端连接，并联积分模块3的输出端与1号加法器11的第三加数输入端连接；
1号加法器11的输出端与2号减法器12的被减数输入端连接，2号减法器12的减数输入端与状态观测器9的角速度输出端连接，2号减法器12的输出端与速度补偿器5的输入端连接，速度补偿器5的输出端与3号减法器13的第二被减数输入端连接，3号减法器13的减数输入端与状态观测器9的角加速度输出端连接，3号减法器13的输出端与加速度补偿器6的输入端连接，加速度补偿器6的输出端与4号减法器14的被减数输入端连接，4号减法器14的减数输入端用于接收液压马达的压力腔与回油腔的压差测量信号；
4号减法器14的输出端与压差补偿器7的输入端连接，压差补偿器7的输出端与模数转换器8的输入端连接，模数转换器8的输出端输出的控制信号通过控制液压马达的电液伺服阀15驱动液压马达转轴运动；
状态观测器9的第一输入端用于接收模数转换器8的输出端输出的控制信号，状态观测器9的第二输入端用于接收液压马达转轴的测量角位置，且状态观测器9用于根据接收的控制信号对液压马达转轴的测量角位置进行观测，生成的估计角速度和估计角加速度分别通过状态观测器9的角速度输出端和角加速度输出端输出。
本实施方式中，位置补偿器4、速度补偿器5、一阶前馈模块1和二阶前馈模块2均可通过现有技术实现，一阶前馈模块1主要用于对给定角加速度进行动态跟踪，二阶前馈模块2主要用于对给定角速度进行动态的跟踪；位置补偿器4主要用于对角位置偏差进行校准，速度补偿器5主要用于对角速度偏差进行校准，加速度补偿器6主要用于对角加速度进行补偿，压差补偿器7主要用于根据接收的压差测量信号对所接收的信号进行数据补偿，从而生成高精度的控制信号，从而提高对液压马达转轴的精确控制，实现对液压马达转轴的精确跟踪及控制，提高控制的稳定性，控制过程简单。
应用时，DSP可采用TI公司的C6748DSP，主频高达456MHZ，具有DDR2：128/256MByte,NAND FLASH:128/256MByte的灵活配置存储空间。
本发明采用控制及调试模式一体化设计，控制参数和调试参数统一规划，参数调试完成后，即刻直接进行控制，无需控制与调试模式转换。
更进一步的，具体应用时，加速度补偿器6对接收的数据乘以加速度控制系数，实现对加速度的补偿，压差补偿器7对接收的数据乘以压差控制系数对压差的补偿。
进一步的，液压马达的压力腔和回油腔的压差测量信号是通过压力传感器获取的。
更进一步的，液压马达转轴的测量角位置是通过编码器测量获取。
更进一步的，位置补偿器4和速度补偿器5均采用相位超前-滞后网络实现。
更进一步的，速度补偿器5所采用的相位超前-滞后网络的状态方程为：
Figure GDA0003813803820000071
其中，Uc(K)为K时刻速度补偿器5输出的速度补偿控制量；
Uc(K-1)为K-1时刻速度补偿器5输出的速度补偿控制量；
T0为时间常数；
Ts为采样周期；
H0为超前滞后因子；
K′为放大倍数；
ε(K)为K时刻速度补偿器5所接收的2号减法器12输出的差值结果；
ε(K-1)为K-1时刻速度补偿器5所接收的2号减法器12输出的差值结果。
更进一步的，在公式一中，
当H0＞1时，速度补偿器5所采用的相位超前-滞后网络为超前网络；
当H0＝1时，速度补偿器5所采用的相位超前-滞后网络为比例放大器；
当0＜H0＜1时，速度补偿器5所采用的相位超前-滞后网络为滞后网络。
更进一步的，位置补偿器4所采用的相位超前-滞后网络的状态方程为：
Figure GDA0003813803820000081
其中，US(K)为K时刻位置补偿器4输出的角位置偏差补偿控制量；
US(K-1)为K-1时刻速位置补偿器4输出的角位置偏差补偿控制量；
T0为时间常数；
Ts为采样周期；
H0为超前滞后因子；
K′为放大倍数；
ε′(K)为K时刻位置补偿器4所接收的1号减法器10输出的角位置偏差；
ε′(K-1)为K-1时刻位置补偿器4所接收的1号减法器10输出的角位置偏差。
更进一步的，在公式二中，
当H0＞1时，位置补偿器4所采用的相位超前-滞后网络为超前网络；
当H0＝1时，位置补偿器4所采用的相位超前-滞后网络为比例放大器；
当0＜H0＜1时，位置补偿器4所采用的相位超前-滞后网络为滞后网络。
更进一步的，一阶前馈模块1采用一阶前馈算法实现，二阶前馈模块2采用二阶前馈算法实现。
实施例2：
具体参见图1，采用所述的一种基于DSP的液压马达控制装置实现的控制方法，该控制方法包括如下过程：
步骤S1、一阶前馈模块1对其接收的液压马达转轴的给定角速度进行补偿，并将给定角速度补偿结果送至1号加法器11的第一加数输入端；
二阶前馈模块2对其接收的液压马达转轴的给定角加速度进行补偿，并将给定角加速度补偿结果送至3号减法器13的第一被减数输入端；
1号减法器10接收的液压马达转轴的给定角位置与测量角位置作差后，获得的角位置偏差同时送至并联积分模块3和位置补偿器4，其中，并联积分模块3用于对接收的角位置偏差进行积分后送至1号加法器11的第三加数输入端，位置补偿器4根据接收的角位置偏差生成角位置偏差补偿控制量，并将角位置偏差补偿控制量送至1号加法器11的第二加数输入端，1号加法器11对接收数据求和后，将其求和结果送至2号减法器12的被减数输入端；
步骤S2、2号减法器12的减数输入端接收状态观测器9输出的估计角速度，3号减法器13的减数输入端接收状态观测器9输出的估计角加速度；
2号减法器12对接收的数据求差，并将其差值结果送至速度补偿器5，速度补偿器5对接收的差值结果生成速度补偿控制量，并将速度补偿控制量送至3号减法器13的第二被减数输入端；
3号减法器13对接收的数据求差后，将其差值结果送至加速度补偿器6，加速度补偿器6对接收的差值结果进行加速度补偿，生成加速度补偿控制量，并将该加速度补偿控制量送至4号减法器14；
4号减法器14对接收的加速度补偿控制量与压差测量信号进行求差，获得压差偏差，并将该压差偏差送至压差补偿器7，压差补偿器7对接收的压差偏差进行补偿，并将生成的压差偏差补偿量送至模数转换器8；
步骤S3、模数转换器8将接收的压差偏差补偿量乘以预设增益后，再进行模数转换，并将模数转换后的结果作为控制信号控制液压马达的电液伺服阀15驱动液压马达转轴运动，从而实现对液压马达转轴的控制。
本发明主控芯片采用可编程DSP芯片实现，控制算法可以C++语言编写后移植到DSP中，控制程序以上位机指令周期为周期，定时运行，上位机软件只需要给定角位置、角速度、角加速度、启动及停止等信号输入，各传感器的数据做为反馈信号，各级补偿器控制参数可调整，完成整个闭环控制最终得出控制量，送至液压马达的电液伺服阀15，液压马达的电液伺服阀15驱动液压马达转轴达到目标位置或角度，控制液压马达完成指定动作要求。
虽然在本文中参照了特定的实施方式来描述本发明，但是应该理解的是，这些实施例仅仅是本发明的原理和应用的示例。因此应该理解的是，可以对示例性的实施例进行许多修改，并且可以设计出其他的布置，只要不偏离所附权利要求所限定的本发明的精神和范围。应该理解的是，可以通过不同于原始权利要求所描述的方式来结合不同的从属权利要求和本文中所述的特征。还可以理解的是，结合单独实施例所描述的特征可以使用在其他所述实施例中。

Claims (10)

1.一种基于DSP的液压马达控制装置，该控制装置基于DSP实现，用于对电液伺服系统中的液压马达转轴进行驱动控制；其特征在于，DSP包括一阶前馈模块(1)、二阶前馈模块(2)、并联积分模块(3)、位置补偿器(4)、速度补偿器(5)、加速度补偿器(6)、压差补偿器(7)、模数转换器(8)、状态观测器(9)、1号减法器(10)、1号加法器(11)、2号减法器(12)、3号减法器(13)和4号减法器(14)；
一阶前馈模块(1)的输入端用于接收液压马达转轴的给定角速度，一阶前馈模块(1)的输出端与至1号加法器(11)的第一加数输入端连接；
二阶前馈模块(2)的输入端用于接收液压马达转轴的给定角加速度，一阶前馈模块(1)的输出端与3号减法器(13)的第一被减数输入端连接；
1号减法器(10)的被减数输入端用于接收液压马达转轴的给定角位置，1号减法器(10)的减数输入端用于接收液压马达转轴的测量角位置，1号减法器(10)输出端与位置补偿器(4)的输入端与并联积分模块(3)的第一输入端连接；
位置补偿器(4)的输出端与1号加法器(11)的第二加数输入端连接，并联积分模块(3)的输出端与1号加法器(11)的第三加数输入端连接；
1号加法器(11)的输出端与2号减法器(12)的被减数输入端连接，2号减法器(12)的减数输入端与状态观测器(9)的角速度输出端连接，2号减法器(12)的输出端与速度补偿器(5)的输入端连接，速度补偿器(5)的输出端与3号减法器(13)的第二被减数输入端连接，3号减法器(13)的减数输入端与状态观测器(9)的角加速度输出端连接，3号减法器(13)的输出端与加速度补偿器(6)的输入端连接，加速度补偿器(6)的输出端与4号减法器(14)的被减数输入端连接，4号减法器(14)的减数输入端用于接收液压马达的压力腔与回油腔的压差测量信号；
4号减法器(14)的输出端与压差补偿器(7)的输入端连接，压差补偿器(7)的输出端与模数转换器(8)的输入端连接，模数转换器(8)的输出端输出的控制信号通过控制液压马达的电液伺服阀(15)驱动液压马达转轴运动；
状态观测器(9)的第一输入端用于接收模数转换器(8)的输出端输出的控制信号，状态观测器(9)的第二输入端用于接收液压马达转轴的测量角位置，且状态观测器(9)用于根据接收的控制信号对液压马达转轴的测量角位置进行观测，生成的估计角速度和估计角加速度分别通过状态观测器(9)的角速度输出端和角加速度输出端输出。
2.根据权利要求1所述的一种基于DSP的液压马达控制装置，其特征在于，液压马达的压力腔和回油腔的压差测量信号是通过压力传感器获取的。
3.根据权利要求1所述的一种基于DSP的液压马达控制装置，其特征在于，液压马达转轴的测量角位置是通过编码器测量获取。
4.根据权利要求1所述的一种基于DSP的液压马达控制装置，其特征在于，位置补偿器(4)和速度补偿器(5)均采用相位超前-滞后网络实现。
5.根据权利要求4所述的一种基于DSP的液压马达控制装置，其特征在于，速度补偿器(5)所采用的相位超前-滞后网络的状态方程为：
Figure FDA0003813803810000021
其中，Uc(K)为K时刻速度补偿器(5)输出的速度补偿控制量；
Uc(K-1)为K-1时刻速度补偿器(5)输出的速度补偿控制量；
T0为时间常数；
Ts为采样周期；
H0为超前滞后因子；
K′为放大倍数；
ε(K)为K时刻速度补偿器(5)所接收的2号减法器(12)输出的差值结果；
ε(K-1)为K-1时刻速度补偿器(5)所接收的2号减法器(12)输出的差值结果。
6.根据权利要求4所述的一种基于DSP的液压马达控制装置，其特征在于，位置补偿器(4)所采用的相位超前-滞后网络的状态方程为：
Figure FDA0003813803810000022
其中，US(K)为K时刻位置补偿器(4)输出的角位置偏差补偿控制量；
US(K-1)为K-1时刻速位置补偿器(4)输出的角位置偏差补偿控制量；
T0为时间常数；
Ts为采样周期；
H0为超前滞后因子；
K′为放大倍数；
ε′(K)为K时刻位置补偿器(4)所接收的1号减法器(10)输出的角位置偏差；
ε′(K-1)为K-1时刻位置补偿器(4)所接收的1号减法器(10)输出的角位置偏差。
7.根据权利要求5所述的一种基于DSP的液压马达控制装置，其特征在于，公式一中，
当H0＞1时，速度补偿器(5)所采用的相位超前-滞后网络为超前网络；
当H0＝1时，速度补偿器(5)所采用的相位超前-滞后网络为比例放大器；
当0＜H0＜1时，速度补偿器(5)所采用的相位超前-滞后网络为滞后网络。
8.根据权利要求6所述的一种基于DSP的液压马达控制装置，其特征在于，公式二中，
当H0＞1时，位置补偿器(4)所采用的相位超前-滞后网络为超前网络；
当H0＝1时，位置补偿器(4)所采用的相位超前-滞后网络为比例放大器；
当0＜H0＜1时，位置补偿器(4)所采用的相位超前-滞后网络为滞后网络。
9.根据权利要求1所述的一种基于DSP的液压马达控制装置，其特征在于，一阶前馈模块(1)采用一阶前馈算法实现，二阶前馈模块(2)采用二阶前馈算法实现。
10.采用权利要求1至8之一所述的一种基于DSP的液压马达控制装置实现的控制方法，其特征在于，该控制方法包括如下过程：
步骤S1、一阶前馈模块(1)对其接收的液压马达转轴的给定角速度进行补偿，并将给定角速度补偿结果送至1号加法器(11)的第一加数输入端；
二阶前馈模块(2)对其接收的液压马达转轴的给定角加速度进行补偿，并将给定角加速度补偿结果送至3号减法器(13)的第一被减数输入端；
1号减法器(10)接收的液压马达转轴的给定角位置与测量角位置作差后，获得的角位置偏差同时送至并联积分模块(3)和位置补偿器(4)，其中，并联积分模块(3)用于对接收的角位置偏差进行积分后送至1号加法器(11)的第三加数输入端，位置补偿器(4)根据接收的角位置偏差生成角位置偏差补偿控制量，并将角位置偏差补偿控制量送至1号加法器(11)的第二加数输入端，1号加法器(11)对接收数据求和后，将其求和结果送至2号减法器(12)的被减数输入端；
步骤S2、2号减法器(12)的减数输入端接收状态观测器(9)输出的估计角速度，3号减法器(13)的减数输入端接收状态观测器(9)输出的估计角加速度；
2号减法器(12)对接收的数据求差，并将其差值结果送至速度补偿器(5)，速度补偿器(5)对接收的差值结果生成速度补偿控制量，并将速度补偿控制量送至3号减法器(13)的第二被减数输入端；
3号减法器(13)对接收的数据求差后，将其差值结果送至加速度补偿器(6)，加速度补偿器(6)对接收的差值结果进行加速度补偿，生成加速度补偿控制量，并将该加速度补偿控制量送至4号减法器(14)；
4号减法器(14)对接收的加速度补偿控制量与压差测量信号进行求差，获得压差偏差，并将该压差偏差送至压差补偿器(7)，压差补偿器(7)对接收的压差偏差进行补偿，并将生成的压差偏差补偿量送至模数转换器(8)；
步骤S3、模数转换器(8)将接收的压差偏差补偿量乘以预设增益后，再进行模数转换，并将模数转换后的结果作为控制信号控制液压马达的电液伺服阀(15)驱动液压马达转轴运动，从而实现对液压马达转轴的控制。
CN202111307946.9A 2021-11-05 2021-11-05 一种基于dsp的液压马达控制装置及方法 Active CN114019874B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111307946.9A CN114019874B (zh) 2021-11-05 2021-11-05 一种基于dsp的液压马达控制装置及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111307946.9A CN114019874B (zh) 2021-11-05 2021-11-05 一种基于dsp的液压马达控制装置及方法

Publications (2)

Publication Number Publication Date
CN114019874A CN114019874A (zh) 2022-02-08
CN114019874B true CN114019874B (zh) 2022-10-11

Family

ID=80061889

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111307946.9A Active CN114019874B (zh) 2021-11-05 2021-11-05 一种基于dsp的液压马达控制装置及方法

Country Status (1)

Country Link
CN (1) CN114019874B (zh)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004178520A (ja) * 2002-11-29 2004-06-24 Nippon Reliance Kk 位置決め制御装置
CN103631281A (zh) * 2013-12-06 2014-03-12 江苏科技大学 一种液压马达角速度伺服系统
CN103633914A (zh) * 2012-08-24 2014-03-12 株式会社安川电机 马达控制装置
CN104345638A (zh) * 2014-10-09 2015-02-11 南京理工大学 一种液压马达位置伺服系统的自抗扰自适应控制方法
CN105278559A (zh) * 2015-11-19 2016-01-27 西安建筑科技大学 变转速液压动力源复合补偿控制系统及方法
CN106066603A (zh) * 2015-04-21 2016-11-02 南京理工大学 具有精确跟踪性能的电液伺服系统自适应鲁棒位置控制器的实现方法
CN110386563A (zh) * 2018-04-23 2019-10-29 杭州诺云科技有限公司 一种基于深沉补偿控制算法的收放存储装置

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108575093B (zh) * 2017-01-12 2020-12-18 株式会社小松制作所 风扇驱动系统及管理系统

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004178520A (ja) * 2002-11-29 2004-06-24 Nippon Reliance Kk 位置決め制御装置
CN103633914A (zh) * 2012-08-24 2014-03-12 株式会社安川电机 马达控制装置
CN103631281A (zh) * 2013-12-06 2014-03-12 江苏科技大学 一种液压马达角速度伺服系统
CN104345638A (zh) * 2014-10-09 2015-02-11 南京理工大学 一种液压马达位置伺服系统的自抗扰自适应控制方法
CN106066603A (zh) * 2015-04-21 2016-11-02 南京理工大学 具有精确跟踪性能的电液伺服系统自适应鲁棒位置控制器的实现方法
CN105278559A (zh) * 2015-11-19 2016-01-27 西安建筑科技大学 变转速液压动力源复合补偿控制系统及方法
CN110386563A (zh) * 2018-04-23 2019-10-29 杭州诺云科技有限公司 一种基于深沉补偿控制算法的收放存储装置

Also Published As

Publication number Publication date
CN114019874A (zh) 2022-02-08

Similar Documents

Publication Publication Date Title
CN111546350B (zh) 一种多关节重载液压机器人系统及高精度运动控制方法
CN110409546B (zh) 一种挖掘机的电控系统及正流量系统挖掘机
CN106292280B (zh) 周期性干扰的期望补偿型自适应鲁棒力控制方法
CN108958023B (zh) 一种电液位置伺服控制系统、计算机终端、存储介质
CN109375584B (zh) 臂架关节控制方法及系统、工程机械及机器可读存储介质
CN111933268B (zh) 一种用于血管介入手术机器人系统的时滞误差预测控制方法
CN111648758B (zh) 一种水井钻机推进装置无模型自适应控制方法及系统
CN114019874B (zh) 一种基于dsp的液压马达控制装置及方法
Koivumäki et al. Adaptive and nonlinear control of discharge pressure for variable displacement axial piston pumps
CN112925208A (zh) 一种数据驱动的水井钻机电液伺服系统扰动补偿方法
Aschemann et al. Decentralised flatness-based control of a hydrostatic drive train subject to actuator uncertainty and disturbances
CN110794878B (zh) 一种随动系统俯仰角度跟踪控制方法
CN109632305B (zh) 一种低速轴承真空跑合测试控制系统
Hu et al. High-order sliding-mode observer based output feedback adaptive robust control of a launching platform with backstepping
CN103647488B (zh) 一种液压马达角位移数字伺服控制系统的控制方法
CN108333919B (zh) 一种考虑路面波动干扰的非平衡身管俯仰位置控制方法
CN115182407A (zh) 用于控制臂架的方法、装置、控制器及工程机械
CN108869690B (zh) 一种多马达同步回转驱动系统及其驱动方法
CN111880483A (zh) 一种雷达天线四电机驱动伺服系统预定性能控制方法
CN113238476A (zh) 一种非平衡炮管高精度抗扰控制方法
RU2268480C1 (ru) Следящий электрогидравлический привод
CN116498538A (zh) 定量液压泵输出流量控制方法和装置
CN108563246B (zh) 显微镜下的旋转定位平台的控制系统和控制方法
JP2652167B2 (ja) パワーショベルの作業機位置制御装置
RU2810327C1 (ru) Сегментный затвор с гидравлическим приводом

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant