Method and apparatus for robust integral-pulse control of a servodrive of unknown dynamics

A method of pulse modulation control of a servodrive comprising the steps of:

• setting a required range of a robustness parameter for a control cycle in proportion to a difference between a maximum and a minimum value of an electromotor's electromechanical time constant,
• reading a current position value of a controlled object,
• calculating a current velocity value of said controlled object by determining a difference between said controlled object's position value in a current control period and its position value in a previous control period and dividing said difference by a control period time consisting of an amount of time that transpires between said two position values of said controlled object,
• calculating a current acceleration/deceleration value of said controlled object by determining a difference between said controlled object's velocity value in the current control period and its velocity value in the previous control period and dividing said difference by said control period time,
• calculating a current robustness parameter value for each control period in proportion to said current acceleration/deceleration value of said controlled object without exceeding an upper limit of the range of the robustness parameter for the control cycle,
• calculating a value for a current velocity error of the controlled object as a difference between a command velocity of the controlled object and said controlled object's actual current velocity,
• calculating for each control period a value for a current pulse duration that is proportional to the value of said controlled object's current velocity error,
• calculating for each control period a value for a current pulse amplitude that is proportional to the value of said controlled object's current velocity error,
• calculating for each control period a value for a current pulse period that is proportional,
• when the controlled object is accelerating, to a sum of a current value of an orthogonality parameter calculated proportionally to said current pulse duration value, and the value of said current robustness parameter
• and that is proportional, when the controlled object is decelerating, to a difference between a current value of an orthogonality parameter calculated proportionally to said current pulse duration value, and said current robustness parameter value,
• calculating for each control period current values of frequencies of additional modulations of pulse amplitude and pulse duration, for modulation ranges limited by said current values of pulse amplitude and pulse duration and limited by the values of said pulse amplitude and pulse duration calculated for the previous control period as then current values for that period, proportionally to said current value of acceleration/deceleration for each control period, and
• creating a sequence of controlling pulses using the current value of pulse period and said additionally modulated pulse amplitude and pulse duration, and feeding a resulting pulse sequence to the electromotor throughout each control period.

An apparatus for pulse modulation control of a servodrive comprising:

• means for setting a required range of a robustness parameter for a control cycle in proportion to a difference between a maximum and a minimum value of an electromotor's electromechanical time constant,
• means for reading a current position value of a controlled object,
• means for calculating a current velocity value of said controlled object by determining a difference between said controlled object's position value in a current control period and its position value in a previous control period and dividing said difference by a control period time consisting of an amount of time that transpires between said two position values of said controlled object,
• means for calculating a current acceleration/deceleration value of said controlled object by determining a difference between said controlled object's velocity value in a current control period and its velocity value in the previous control period and dividing said difference by said control period time,
• means for calculating a current robustness parameter value for each control period in proportion to said current acceleration/deceleration value of said controlled object without exceeding an upper limit of the range of the robustness parameter for the control cycle,
• means for calculating a value for a current position error of the controlled object as a difference between a command position of the controlled object and said controlled object's actual current position,
• means for calculating for each control period a value for a current pulse duration that is proportional to the value of said controlled object's current position error,
• means for calculating for each control period a value for a current pulse amplitude that is proportional to the value of said controlled object's current position error,
• means for calculating for each control period a value for a current pulse period that is proportional,
• when the controlled object is accelerating, to a sum of a current value of an orthogonality parameter calculated proportionally to said current pulse duration value, and the value of said current robustness parameter
• and that is proportional, when the controlled object is decelerating, to a difference between a current value of an orthogonality parameter calculated proportionally to said current pulse duration value, and said current robustness parameter value,
• means for calculating for each control period current values of frequencies of additional modulations of pulse amplitude and pulse duration, for modulation ranges limited by said current values of pulse amplitude and pulse duration and limited by the values of said pulse amplitude and pulse duration calculated for the previous control period as then current values for that period, proportionally to said current value of acceleration/deceleration for each control period, and
• means for creating a sequence of controlling pulses using the current value of pulse period and said additionally modulated pulse amplitude and pulse duration, and feeding a resulting pulse sequence to the electromotor throughout each control period.

An apparatus for pulse modulation control of a servodrive comprising:

• means for setting a required range of a robustness parameter for a control cycle in proportion to a difference between a maximum and a minimum value of an electromotor's electromechanical time constant,
• means for reading a current position value of a controlled object,
• means for calculating a current velocity value of said controlled object by determining a difference between said controlled object's position value in a current control period and its position value in a previous control period and dividing said difference by a control period time consisting of an amount of time that transpires between said two position values of said controlled object,
• means for calculating a current acceleration/deceleration value of said controlled object by determining a difference between said controlled object's velocity value in the current control period and its velocity value in the previous control period and dividing said difference by said control period time,
• means for calculating a current robustness parameter value for each control period in proportion to said current acceleration/deceleration value of said controlled object without exceeding an upper limit of the range of the robustness parameter for the control cycle,
• means for calculating a value for a current velocity error of the controlled object as a difference between a command velocity of the controlled object and said controlled object's actual current velocity,
• means for calculating for each control period a value for a current pulse duration that is proportional to the value of said controlled object's current velocity error,
• means for calculating for each control period a value for a current pulse amplitude that is proportional to the value of said controlled object's current velocity error,
• means for calculating for each control period a value for a current pulse period that is proportional,
• when the controlled object is accelerating, to a sum of a current value of an orthogonality parameter calculated proportionally to said current pulse duration value, and the value of said current robustness parameter
• and that is proportional, when the controlled object is decelerating, to a difference between a current value of an orthogonality parameter calculated proportionally to said current pulse duration value, and said current robustness parameter value,
• means for calculating for each control period current values of frequencies of additional modulations of pulse amplitude and pulse duration, for modulation ranges limited by said current values of pulse amplitude and pulse duration and limited by the values of said pulse amplitude and pulse duration calculated for the previous control period as then current values for that period, proportionally to said current value of acceleration/deceleration for each control period, and
• means for creating a sequence of controlling pulses using the current value of pulse period and said additionally modulated pulse amplitude and pulse duration, and feeding a resulting pulse sequence to the electromotor throughout each control period.