APPARATUS AND METHOD FOR CONTROLLING MOTOR DRIVEN POWER STEERING SYSTEM
Disclosed are an apparatus and a method for controlling a motor driven power steering system. The apparatus for controlling a motor driven power steering system includes a steering angle position controller configured to control a steering angle by adjusting a gain value based on a steering angle error between a command steering angle inputted by an autonomous driving system and a current steering angle; a current controller configured to compensate for a current error between a second command current outputted from the steering angle position controller and a sensor current; and a disturbance estimator configured to estimate noise due to an external factor, to remove the estimated noise in advance from a third command current outputted from the current controller, and to apply the third command current with no noise to an MDPS.
Latest HYUNDAI MOBIS CO., LTD. Patents:
This application claims priority from and the benefit of Korean Patent Application No. 10-2020-0150045, filed on Nov. 11, 2020, which is hereby incorporated by reference for all purposes as if set forth herein.
BACKGROUND FieldExemplary embodiments of the present disclosure relate to an apparatus and a method for controlling a motor driven power steering system, and more particularly, to an apparatus and a method for controlling a motor driven power steering system, which can enhance instantaneous responsiveness when sudden steering is required during autonomous driving and stably maximize performance against noise due to external factors.
Discussion of the BackgroundIn general, a hydraulic power steering apparatus using the hydraulic pressure of a hydraulic pump is used as a power-assisted steering apparatus for a vehicle, but a motor driven power steering (MDPS) system using an electric motor has been extensively used since the 1990s.
The existing hydraulic power steering apparatus always consumes power regardless of whether a steering wheel is turned because a hydraulic pump, which is a power source for assisting power, is driven by an engine. However, in the MDPS system, when the steering wheel is turned and a torque is generated, a motor driven by electric energy provides steering assistance power.
Accordingly, when the MDPS system (or motor driven power steering) is used, it is advantageous in that vehicle energy efficiency can be improved compared to the hydraulic power steering apparatus.
Meanwhile, when a risk of a collision or another accident suddenly occurs during autonomous driving, a vehicle adopting an autonomous driving mode needs to reduce a vehicle speed or avoid obstacles and the like through steering control. However, a vehicle adopting the existing autonomous driving mode is only designed to cope with a typical situation where an obstacle is detected in advance ahead of a designated distance, and is not designed to cope with an emergency situation (for example, a situation where a pedestrian or another vehicle suddenly cuts in front of the vehicle).
Accordingly, it is typically effective to reduce a vehicle speed in advance in a non-emergency situation, but sudden steering may be more effective in avoiding an accident in an emergency situation (for example, a situation where a pedestrian or another vehicle suddenly cuts in front of the vehicle). However, if an autonomous driving mode is canceled or is not normally performed in such an emergency situation, as in a vehicle adopting the existing autonomous driving mode, a driver (or a user) may be more at risk. Thus, a technology of maximizing responsiveness is required so that quick steering can be instantaneously achieved in response to an emergency situation while the autonomous driving mode is being continuously maintained. At this time, the motor of the MDPS can be controlled, but a steering wheel connected to a column may be shaken. When the responsiveness is unintentionally enhanced too much, control stability is reduced, which may reduce the responsiveness of a controller due to disturbance caused by external factors, frictional force of a mechanism, sensor noise, and the like, or cause unintentional vibration.
In this regard, it is required to develop a technology capable of enhancing instantaneous responsiveness when sudden steering is required during autonomous driving and stably maximizing performance against noise due to external factors.
The background art of the present disclosure is disclosed in Korean Patent Application Laid-Open No. 10-2019-0098783 (published on Aug. 23, 2019 and entitled “Apparatus for Controlling Handle of Vehicles”).
SUMMARYThe present disclosure has been made to solve the above problems, and an object according to one aspect of the present disclosure is to provide an apparatus and a method for controlling a motor driven power steering system, which can enhance instantaneous responsiveness when sudden steering is required during autonomous driving of a vehicle and stably maximize performance against noise due to external factors.
An apparatus for controlling a motor driven power steering system in accordance with one aspect of the present disclosure may include: a steering angle position controller configured to control a steering angle by adjusting a gain value based on a steering angle error between a command steering angle inputted by an autonomous driving system and a current steering angle; a current controller configured to compensate for a current error between a second command current outputted from the steering angle position controller and a sensor current; and a disturbance estimator configured to estimate noise due to an external factor, to remove the estimated noise in advance from a third command current outputted from the current controller, and to apply the third command current with no noise to an MDPS.
In the present disclosure, the steering angle position controller may include: a steering angle control unit configured to output a command speed by compensating for the steering angle error that is a difference between the command steering angle and the current steering angle, and to output a first command current by compensating for a speed error that is a difference between the command speed and a current steering angular velocity; a variable high-pass filter configured to high-frequency filter the steering angle error by adjusting a cut-off frequency; a gain adjustment section configured to adjust a gain of the variable high-pass filter by using at least one of a vehicle speed and the current steering angular velocity; and an adjustment section configured to output a second command current by arithmetically processing the first command current outputted from the steering angle control unit and a required current outputted from the gain adjustment section.
In the present disclosure, the variable high-pass filter may adjust the cut-off frequency by adjusting a differential time of a transfer function.
In the present disclosure, the gain adjustment section may adjust the gain by multiplying a load curve gain based on the vehicle speed, the current steering angular velocity, and a preset ratio.
In the present disclosure, the steering angle control unit may include: a position controller configured to compensate for the steering angle error; and a speed controller configured to compensate for the speed error between a command speed outputted from the position controller and the current steering angular velocity.
In the present disclosure, the apparatus may further include a vibration sensing section configured to detect vibration on the basis of the number of changes in a sign of the steering angular velocity, and to return the cut-off frequency or the gain to an initial value according to the detected vibration.
In the present disclosure, the disturbance estimator may include: an inverse transfer function unit configured to calculate an inverse transfer function of the MDPS and to apply output of the MDPS to the inverse transfer function; a first variable Q-filter provided at a front terminal of the inverse transfer function unit and configured to convert the degrees of a numerator and a denominator of the inverse transfer function to be equal to each other; a second variable Q-filter provided in parallel to an input terminal of the MDPS; a noise estimation unit configured to calculate a noise estimate by subtracting output of the second variable Q-filter from a multiplication result of the inverse transfer function unit and the first variable Q-filter; and a noise removal unit configured to subtract the noise estimate from the third command current and apply a subtraction result to the MDPS.
In the present disclosure, the first variable Q-filter and the second variable Q-filter may be low-pass filters.
In the present disclosure, the low-pass filter may adjust a cut-off frequency according to a current steering angular velocity.
A method for controlling a motor driven power steering system in accordance with another aspect of the present disclosure may include: a step in which a steering angle position controller controls a steering angle by adjusting a gain value based on a steering angle error between a command steering angle inputted by an autonomous driving system and a current steering angle; a step in which a current controller compensates for a current error between a second command current outputted from the steering angle position controller and a sensor current; and a step in which a disturbance estimator estimates noise due to an external factor, removes the estimated noise in advance from a third command current outputted from the current controller, and applies the third command current with no noise to an MDPS.
In the present disclosure, the step of controlling the steering angle may include: a step in which a steering angle control unit outputs a command speed by compensating for the steering angle error that is a difference between the command steering angle and the current steering angle, and outputs a first command current by compensating for a speed error that is a difference between the command speed and a current steering angular velocity; a step in which a variable high-pass filter high-frequency filters the steering angle error by adjusting a cut-off frequency; a step in which a gain adjustment section adjusts a gain of the variable high-pass filter by using at least one of a vehicle speed and the current steering angular velocity; and a step in which an adjustment section outputs a second command current by arithmetically processing the first command current outputted from the steering angle control unit and a required current outputted from the gain adjustment section.
In the present disclosure, in the step of high-frequency filtering the steering angle error, the variable high-pass filter may adjust the cut-off frequency by adjusting a differential time of a transfer function.
In the present disclosure, in the step of adjusting the gain of the variable high-pass filter, the gain adjustment section may adjust the gain by multiplying a load curve gain based on the vehicle speed, the current steering angular velocity, and a preset ratio.
In the present disclosure, the step of outputting the first command current may include: a step in which a position controller compensates for the steering angle error; and a step in which a speed controller compensates for the speed error between a command speed outputted from the position controller and the current steering angular velocity.
In the present disclosure, the method may further include a step in which a vibration sensing section detects vibration on the basis of the number of changes in a sign of the steering angular velocity, and returns the cut-off frequency or the gain to an initial value according to the detected vibration.
In the present disclosure, the step of removing the estimated noise in advance from the third command current outputted from the current controller and applying the third command current with no noise to the MDPS may include: a step in which an inverse transfer function unit calculates an inverse transfer function of the MDPS and applies output of the MDPS to the inverse transfer function; a step in which a first variable Q-filter provided at a front terminal of the inverse transfer function unit converts the degrees of a numerator and a denominator of the inverse transfer function to be equal to each other; a step in which a noise estimation unit calculates a noise estimate by subtracting output of a second variable Q-filter provided in parallel to an input terminal of the MDPS from a multiplication result of the inverse transfer function unit and the first variable Q-filter; and a step in which a noise removal unit subtracts the noise estimate from the third command current and applies a subtraction result to the MDPS.
In the present disclosure, the first variable Q-filter and the second variable Q-filter may be low-pass filters.
In the present disclosure, the low-pass filter may adjust a cut-off frequency according to a current steering angular velocity.
An apparatus and a method for controlling a motor driven power steering system in accordance with one aspect of the present disclosure have the effect of avoiding an accident by enhancing instantaneous responsiveness when sudden steering is required during autonomous driving of a vehicle and stably maximizing performance against noise due to external factors.
As is traditional in the corresponding field, some exemplary embodiments may be illustrated in the drawings in terms of functional blocks, units, and/or modules. Those of ordinary skill in the art will appreciate that these block, units, and/or modules are physically implemented by electronic (or optical) circuits such as logic circuits, discrete components, processors, hard-wired circuits, memory elements, wiring connections, and the like. When the blocks, units, and/or modules are implemented by processors or similar hardware, they may be programmed and controlled using software (e.g., code) to perform various functions discussed herein. Alternatively, each block, unit, and/or module may be implemented by dedicated hardware or as a combination of dedicated hardware to perform some functions and a processor (e.g., one or more programmed processors and associated circuitry) to perform other functions. Each block, unit, and/or module of some exemplary embodiments may be physically separated into two or more interacting and discrete blocks, units, and/or modules without departing from the scope of the inventive concept. Further, blocks, units, and/or module of some exemplary embodiments may be physically combined into more complex blocks, units, and/or modules without departing from the scope of the inventive concept.
Hereinafter, an apparatus and a method for controlling a motor driven power steering system in accordance with the present disclosure will be described in detail with reference to the accompanying drawings. In this process, the thicknesses of lines or the sizes of elements illustrated in the drawings may be exaggerated for the purpose of clarity and convenience of explanation. Furthermore, terms to be described later are terms defined in consideration of functions thereof in the present disclosure and may be changed according to the intention of a user or an operator, or practice. Accordingly, such terms should be defined based on the disclosure over the present specification.
Furthermore, the implementations described in the present specification may be implemented as a method or process, an apparatus, a software program, a data stream or signal, for example. Although discussed only in the context of a single form of implementation (for example, discussed only as a method), the discussed features may also be implemented as other forms (for example, an apparatus or a program). The apparatus may be implemented as appropriate hardware, software, firmware and the like. The method may be implemented in an apparatus such as a processor generally referring to a processing device including a computer, a microprocessor, an integrated circuit, or a programmable logic device. The processor includes a communication device such as a computer, a cellular phone, a portable/personal digital assistant (PDA), and other devices that facilitate communication of information between end users.
Referring to
The sensing module 10 senses information necessary for autonomous driving and steering control. The sensing module 10 may include a surrounding environment sensing unit 11 that senses surrounding environment information necessary for an operation of the autonomous driving system 20, a vehicle speed sensing unit 12 that senses a vehicle speed of a vehicle, a steering angle sensing unit 13 that senses a steering angle of a steering wheel, and a steering angular velocity detection unit 14 that detects a steering angular velocity of the steering wheel.
The steering angular velocity detection unit 14 may directly detect the steering angular velocity from the steering wheel, but may also detect the steering angular velocity sensed by the steering angle sensing unit 13 by differentiating the steering angular velocity.
Examples of the surrounding environment sensing unit 11 may include a LIDAR, a radar, an ultrasonic sensor, an image sensor, and the like. Examples of the surrounding environment information may include road information, obstacle information, weather information, and the like. The surrounding environment information is not limited to the aforementioned examples.
The autonomous driving system 20 outputs a command steering angle for autonomous driving control of the vehicle on the basis of the surrounding environment information inputted by the surrounding environment sensing unit 11 in an autonomous driving mode.
Since those skilled in the art can easily embody that the autonomous driving system 20 performs the autonomous driving control on the basis of the surrounding environment information, detailed description thereof will be omitted.
The steering angle position controller 100 controls a steering angle by adjusting a gain according to a steering angle error (that is, position control error) that is a difference between the command steering angle and a current steering angle.
In general, the autonomous driving is performed through recent steering angle position control. That is, when the autonomous driving system 20 applies the command steering angle to an MDPS 30, the MDPS 30 performs position control according to the command steering angle. In general, the steering angle position controller 100 may include a steering angle control unit 110 including a position controller 112 and a speed controller 114.
The position controller 112 may compensate for the steering angle error that is a difference between the command steering angle and the current steering angle. The position controller 112 may be composed of a P controller.
The speed controller 114 may compensate for a speed error between a command speed outputted from the position controller 112 and the current steering angular velocity. The speed controller 114 may be composed of a PI controller.
However, the steering angle control unit 110 composed of the position controller 112 and the speed controller 114 has a limitation in enhancing responsiveness. Thus, the steering angle position controller 100 may further include a variable high-pass filter (HPF) 120, a gain adjustment section 130, and an adjustment section 140. The steering angle position controller 100 may high-frequency filter an error value that is a difference between the command steering angle and the current steering angle, and apply a value obtained by multiplying the filtered value by a gain to a front terminal of the current controller. This serves to add an additional required current to a command current, thereby enhancing the responsiveness of the steering angle position controller 100. Such a configuration is the same as a configuration in which a D controller is actually added, but for convenience, efficiency and the like of controller design, it is reconstructed with a combination of the variable HPF 120 and the gain adjustment section 130.
The variable HPF 120 removes a noise component by high-frequency filtering the steering angle error, which is a difference between the command steering angle and the current steering angle, by adjusting a cut-off frequency. In such a case, the variable HPF 120 may adjust the cut-off frequency by adjusting a differential time of a transfer function.
The gain adjustment section 130 adjusts a gain of the variable HPF 120 by using at least one of a vehicle speed and the current steering angular velocity. That is, the gain adjustment section 130 adjusts the gain by multiplying a load curve gain based on the vehicle speed, a command steering angular velocity, and a preset ratio.
The adjustment section 140 outputs a second command current by arithmetically processing a first command current outputted from the speed controller 114 and a required current outputted from the gain adjustment section 130. At this time, the adjustment section 140 may output the second command current by adding the first command current and the required current.
In a general autonomous driving mode, when steering angle control performance is too high, control stability may be reduced due to external noise, surrounding environments, and the like to cause vibration and the like, and the steering angle control performance may be reduced. Accordingly, it is very important to essentially maximize the steering angle control performance when necessary.
To this end, it is effective to use a PI-P controller or a PID-PI controller instead of a steering angle position controller 100 with a combination of P-PI controllers generally used. However, when a D controller is applied to the steering angle position controller 100, vibration may occur due to noise of the command steering angle, external environments, or noise. In general, the D controller is added to the steering angle position controller 100 to enhance responsiveness to a change in position, but this may cause vibration due to amplification caused by disturbance or noise introduced from the external environments, resulting in a reduction of the steering angle control performance.
In order to substantially prevent such a problem, a low-pass filter or a lag-compensator is usually applied to a front terminal of the D controller. However, in this case, the structure is complicated, and when a variation is required depending on steering situations, the number of parameters or factor values to be changed increases. That is, in general, the steering angle position controller 100 uses a PI-PI or PID-PI configuration in which a P controller terminal in a P-PI is designed with a PI or a PID. However, there is a need for a more efficient method capable of significantly improving responsiveness while being tolerant to noise or disturbance by maximizing the performance of the controller depending on steering situations.
Accordingly, when a low-pass filter (LPF) or a lag-compensator is typically applied to the D controller in the PID controller, an Equation G(s) may be expressed as Kp(1+1/Ti×s+Td×s/(1+s×Td)). Here, G(s) may denote a transfer function, Kp may denote a proportional gain, Ti may denote an integration time, Td may denote a differential time, and s may denote a complex number. In the Equation above, when the PID control gain is separated (that is, Kp is separated according to the I or D controller), G(s) may be expressed as Kp+Ki/Ti×s+Kd×s/(1+Td×s). At this time, when the D control is rearranged, G(s) may be expressed as (1/Td)/((1/Td+s))×Td×Kd×s. Here, Ki may denote an integral gain and Kd may denote a differential gain.
Meanwhile, (1/Td)/((1/Td+s)) and s are similar to those of a first-order high-pass filter. By applying this, when the variable HPF 120 and the gain adjustment section 130 are applied instead of the D controller, it is possible to generate a structure that is robust to noise and can improve steering angle control performance. In such a case, the gain and the cut-off frequency of the variable HPF 120 are very important.
Typically, the cut-off frequency of a high-pass filter may be set by applying a motor control bandwidth of a motor driven power steering, for example, the MDPS 30. However, in order not to affect a torsion bar resonance point of the MDPS 30, it is important to set the cut-off frequency of the high-pass filter so as not to affect the resonance point by using, as cut-off points, about 12 Hz in the case of C-MDPS and about 9 Hz in the case of R-MDPS, respectively. For reference, the most significant factor in the stability of the MDPS 30 is a torsion bar. This is because the torsion bar has the lowest rigidity and is the point at which resonance is highly likely to occur.
In general, in the case of the differential time Td, the PID controller may define the control period and frequency of the D controller. In (1/Td)/((1/Td)+s))×Td×Kd×s of the transfer function, (1/Td)/((1/Td)+s)) is the same as that of a high-pass filter and a desired frequency may be set through 1/Td. That is, the transfer function of a general high-pass filter may be expressed as s/(s+w). Here, w may denote 2πf and f may denote a cut-off frequency. In the aforementioned transfer function, since 1/Td is directly w, the variable HPF 120 may adjust a cut-off frequency by varying the Td value in order to set a desired frequency.
The gain adjustment section 130 adjusts the gain by multiplying the load curve gain based on the vehicle speed, the command steering angular velocity, and the preset ratio.
The gain adjustment section 130 varies the differential gain Kd value in order to control the gain. As already defined, by increasing the Kd value in the transfer function as the steering angular velocity is high and decreasing the Kd value as the steering angular velocity is low, the gain response characteristics of the steering angle position controller 100 may be varied.
The important factors for determining the gain are the vehicle speed and the command steering angular velocity. In order to determine a load of the vehicle and a load applied to the MDPS 30, it is essential to consider the vehicle speed and the command steering angular velocity.
Accordingly, the gain adjustment section 130 finally adjusts the gain by multiplying the load curve gain value based on the vehicle speed, the steering angular velocity, and a ratio for substantially maintaining an appropriate parameter. The ratio may be variously set in consideration of various sudden steering environments in actual autonomous driving conditions. In consideration of the control stability of the MDPS 30, the load curve gain value based on the vehicle speed, the steering angular velocity, and the ratio are stored in a tuning map and operated. Since the gain increases only when the steering angular velocity is fast or the load based on the vehicle speed increases, the responsiveness is not increased in the case of low-speed steering, so that position control is smoothly performed without shaking of a steering wheel. In such a case, a fast steering response is not necessary, so smooth control performance may be prioritized. As a consequence, the shape of the variable HPF 120 may be changed as illustrated in
However, when sudden steering is performed during autonomous driving, vibration and the like may occur due to factors such as external environments. In such a case, it is necessary to sense the vibration and the like in advance and to substantially prevent an excessive increase in the gain G or a change in the cut-off frequency of the variable HPF 120.
To this end, a vibration sensing section 150 monitors in realtime a change in the sign of the steering angular velocity for a specified period of time. For example, as illustrated in
Typically, in the MDPS 30, since the torsion bar has the lowest rigidity, vibration is highly likely to occur at the resonant frequency of the torsion bar. This usually corresponds to 8 Hz to 12 Hz, and for example, when a sign change has occurred 17 times per second, it may be assumed that vibration of 8 Hz occurs, which may be considered as an excessive increase in the gain G or an excessive decrease in the cut-off frequency of the variable HPF 120. Accordingly, the vibration sensing section 150 detects vibration on the basis of the number of changes in the sign of the steering angular velocity, and returns the cut-off frequency or the gain to an initial value when the detected vibration is equal to or greater than set vibration. The initial value may be a gain G value or a cut-off frequency in a general autonomous driving mode.
Meanwhile, when the MDPS 30 performs position control in a normal situation during autonomous driving, the steering angle position controller 100 is designed and the PID gain is tuned in order to substantially prevent the resonance of the MDPS 30. However, when the performance of the steering angle position controller 100 is maximized for instantaneous obstacle avoidance, that is, when the gain G is instantaneously increased or the cut-off frequency of the variable HPF 120 is decreased to a region near 8 Hz to 12 Hz, a gain based on frequency characteristics increases. Thus, the stability of the steering angle position controller 100 is reduced, so that vibration may occur. This can be controlled by decreasing the gain G or returning the cut-off frequency of the variable HPF 120 to a level of a normal condition in which no vibration occurs when the vibration sensing section 150 detects a signal with the resonant frequency 8 Hz to 12 Hz of the torsion bar, which is not generally detected by the MDPS 30.
In other words, when the gain G of the steering angle position controller 100 is increased to enhance instantaneous responsiveness or the cut-off frequency is adjusted to increase the gain characteristics of a frequency requiring instantaneous steering (generally, in the case of the variable HPF 120, the lower the cut-off frequency, the higher the gain level based on the frequency of 8 Hz to 12 Hz), the safety margin of the steering angle position controller 100 is reduced. In this regard, in the present embodiment, the vibration sensing section 150 monitors the safety margin of the steering angle position controller 100, and returns the performance of the steering angle position controller 100 to the normal state again when it is determined that vibration occurs.
Through the above, autonomous driving cancellation is blocked in the case of sudden steering, and the performance of the steering angle position controller 100 is maximized through the variable HPF 120, which makes it possible to allow an autonomous driving vehicle to avoid obstacles in an emergency situation. In addition, the cut-off frequency of the variable HPF 120, which has been changed by the amount of a position control error, is returned again according to a general autonomous driving situation, and when vibration has occurred depending on the situation during sudden steering, a side effect due to emergency steering can also be substantially prevented by detecting the vibration and optimizing the variable HPF 120.
The current controller 200 compensates for a current error between a second command current outputted from the steering angle position controller 100 and a sensor current. In such a case, the current controller 200 may be a PI controller and the sensor current may be a current obtained by an MCU (not illustrated) that senses a motor.
When the second command current and the sensor current are received from the steering angle position controller 100 and the MCU, respectively, the current controller 200 may output a third command current by compensating for an error corresponding to a difference between the second command current and the sensor current.
Meanwhile, the performance of the control device may be reduced due to unexpected external factors such as external noise, frictional force, and sensor noise. In order to substantially prevent such a problem, it is necessary to observe the noise and remove the noise from the command current in advance. To this end, the present disclosure includes the disturbance estimator 300 that removes external noise due to external factors from the third command current outputted from the current controller 200.
The disturbance estimator 300 includes an inverse transfer function unit 310, a first variable Q-filter 320, a second variable Q-filter 330, a noise estimation unit 340, and a noise removal unit 350.
The inverse transfer function unit 310 calculates an inverse transfer function of the MDPS 30 and applies the output of the MDPS 30 to the inverse transfer function. When the output of the MDPS 30 is applied to the inverse transfer function, the inverse transfer function unit 310 may extract an input value of the MDPS 30, that is, a component in which the third command current and a noise component are added. By subtracting a current MDPS input value (that is, the third command current) from the extracted input value, only noise may be extracted. When this is applied to the actual output of the controller, input with no noise may be applied to the MDPS 30.
However, when the inverse transfer function of the MDPS 30 is calculated and applied, the degree of the numerator is larger than that of the denominator, which causes the instability of the MDPS 30 (system). For example, when it is assumed that there is a system called s/(s2+1), the inverse function thereof is (s2+1)/s, which is generally defined in the form of an HPF or a filter in which an input signal diverges to infinity. Thus, it is not possible to design and apply the MDPS 30 (system) in such a way. In order to stabilize such system instability, a variable Q-filter may be applied. The variable Q-filter may be, for example, a low-pass filter. When a first-order low-pass filter w/(s+w) is applied to the front terminal of the inverse transfer function unit 310, the degrees of the numerator and the denominator of the inverse transfer function of the MDPS 30 (system) are converted to be the same, so that the MDPS 30 (system) may be stabilized. By applying this in parallel to the input terminal of the MDPS 30 (system), the characteristics of the MDPS 30 (system) may not be actually affected. That is, the first variable Q-filter 320 may be applied to the front terminal of the inverse transfer function unit 310 and the second variable Q-filter 330 may be applied in parallel to the input terminal of the MDPS 30. At this time, it is important to set the cut-off frequency of the low-pass filter. The MDPS 30 (motor driven power steering) is a system to which a motor is applied, and as the motor actually rotates at a higher speed, actual control characteristics thereof are reduced due to the influence of a back electromotive force. That is, there occurs a phenomenon in which desired controller output is not outputted properly, and it is necessary to compensate for this phenomenon. This may be compensated for by the variable HPF 120 and the gain adjustment section 130 of the present disclosure, but in order to additionally improve such a point, the cut-off frequency of the low-pass filter needs to be shift forward. That is, it has the effect of increasing the bandwidth, so that responsiveness may be improved even at a high speed. However, when low-speed steering or smooth steering is required, responsiveness may be adjusted by lowering the cut-off frequency of the low-pass filter. With such a configuration, more precise control performance and optimized position control in various environments can be achieved.
The noise estimation unit 340 calculates a noise estimate by subtracting the output of the second variable Q-filter 330 from the multiplication result of the inverse transfer function unit 310 and the first variable Q-filter 320. For example, when the MDPS output is y, the inverse transfer function is G−1(z), the second variable Q-filter 330 is Q(z), and a fourth command current is u, the noise estimation unit 340 may calculate a noise estimate {circumflex over (d)} as expressed by Equation 1 below.
{circumflex over (d)}=Q(z)G−1(z)y−Q(z)u Equation 1
The noise removal unit 350 subtracts the noise estimate from the third command current and applies the fourth command current to the MDPS 30. That is, when the noise estimate is subtracted from the third command current in advance, even though external noise is inputted before the command current is inputted to the MDPS 30, a desired command current may be inputted to the MDPS 30 because the noise estimate has been removed in advance. The desired command current may be a final command current to be inputted to the MDPS 30, that is, a command current in which the external noise is added to the fourth command current.
Hereinafter, a method for controlling a motor driven power steering system in accordance with an embodiment of the present disclosure will be described with reference to
Referring to
After step S410 is performed, the steering angle position controller 100 high-frequency filters the steering angle error that is a difference between the command steering angle and the current steering angle, multiplies the filtered result by a gain, and outputs a required current (S420). At this time, the variable HPF 120 may remove a noise component by high-frequency filtering the steering angle error that is a difference between the command steering angle and the current steering angle. Then, the gain adjustment section 130 may adjust the gain of the variable HPF 120 by multiplying a load curve gain based on a vehicle speed, a command steering angular velocity, and a preset ratio.
After step S420 is performed, the steering angle position controller 100 outputs the second command current by adding the first command current and the required current (S430). In this process, the vibration sensing section 150 monitors in realtime the number of changes in the sign of the steering angular velocity during a vibration setting time, detects vibration of the steering angle, and determines whether the detected vibration is equal to or greater than set vibration. As a result of the determination, when the vibration is equal to or greater than the set vibration, the vibration sensing section 150 may return the cut-off frequency or the gain to an initial value.
After step S430 is performed, the current controller 200 outputs the third command current by compensating for a current error between the second command current outputted from the steering angle position controller 100 and the sensor current (S440). At this time, when the second command current and the sensor current are received from the steering angle position controller 100 and the MCU, respectively, the current controller 200 may output the third command current by compensating for an error corresponding to a difference between the second command current and the sensor current.
After step S440 is performed, the disturbance estimator 300 subtracts the noise estimate from the third command current outputted from the current controller 200 (S450), and applies the fourth command current to the MDPS 30 (S460).
As described above, the apparatus and the method for controlling a motor driven power steering system in in accordance with one aspect of the present disclosure have the effect of avoiding an accident by enhancing instantaneous responsiveness when sudden steering is required during autonomous driving of a vehicle and stably maximizing performance against noise due to external factors.
Although the present disclosure has been described with reference to the embodiments illustrated in the drawings, the embodiments of the disclosure are for illustrative purposes only, and those skilled in the art will appreciate that various modifications and other equivalent embodiments are possible from the embodiments. Thus, the true technical scope of the present disclosure should be defined by the following claims.
Claims
1. An apparatus for controlling a motor driven power steering system, the apparatus comprising:
- a steering angle position controller configured to control a steering angle by adjusting a gain value based on a steering angle error between a command steering angle inputted by an autonomous driving system and a current steering angle;
- a current controller configured to compensate for a current error between a second command current outputted from the steering angle position controller and a sensor current; and
- a disturbance estimator configured to estimate noise due to an external factor, to remove the estimated noise in advance from a third command current outputted from the current controller, and to apply the third command current with no noise to a motor driven power steering (MDPS).
2. The apparatus according to claim 1, wherein the steering angle position controller comprises:
- a steering angle control unit configured to output a command speed by compensating for the steering angle error that is a difference between the command steering angle and the current steering angle, and to output a first command current by compensating for a speed error that is a difference between the command speed and a current steering angular velocity;
- a variable high-pass filter configured to high-frequency filter the steering angle error by adjusting a cut-off frequency;
- a gain adjustment section configured to adjust a gain of the variable high-pass filter by using at least one of a vehicle speed and the current steering angular velocity; and
- an adjustment section configured to output a second command current by arithmetically processing the first command current outputted from the steering angle control unit and a required current outputted from the gain adjustment section.
3. The apparatus according to claim 2, wherein the variable high-pass filter is configured to adjust the cut-off frequency by adjusting a differential time of a transfer function.
4. The apparatus according to claim 2, wherein the gain adjustment section is configured to adjust the gain by multiplying a load curve gain based on the vehicle speed, the current steering angular velocity, and a preset ratio.
5. The apparatus according to claim 2, wherein the steering angle control unit comprises:
- a position controller configured to compensate for the steering angle error; and
- a speed controller configured to compensate for the speed error between a command speed outputted from the position controller and the current steering angular velocity.
6. The apparatus according to claim 2, further comprising:
- a vibration sensing section configured to detect vibration on the basis of the number of changes in a sign of the steering angular velocity, and to return the cut-off frequency or the gain to an initial value according to the detected vibration.
7. The apparatus according to claim 1, wherein the disturbance estimator comprises:
- an inverse transfer function unit configured to calculate an inverse transfer function of the MDPS and to apply output of the MDPS to the inverse transfer function;
- a first variable Q-filter provided at a front terminal of the inverse transfer function unit and configured to convert degrees of a numerator and a denominator of the inverse transfer function to be equal to each other;
- a second variable Q-filter provided in parallel to an input terminal of the MDPS;
- a noise estimation unit configured to calculate a noise estimate by subtracting output of the second variable Q-filter from a multiplication result of the inverse transfer function unit and the first variable Q-filter; and
- a noise removal unit configured to subtract the noise estimate from the third command current and apply a subtraction result to the MDPS.
8. The apparatus according to claim 7, wherein the first variable Q-filter and the second variable Q-filter are low-pass filters.
9. The apparatus according to claim 8, wherein the low-pass filter is configured to adjust a cut-off frequency according to a current steering angular velocity.
10. A method for controlling a motor driven power steering system, the method comprising:
- controlling, by a steering angle position controller, a steering angle by adjusting a gain value based on a steering angle error between a command steering angle inputted by an autonomous driving system and a current steering angle;
- compensating, by a current controller, for a current error between a second command current outputted from the steering angle position controller and a sensor current;
- estimating, by a disturbance estimator, noise due to an external factor;
- removing, by the disturbance estimator, the estimated noise in advance from a third command current outputted from the current controller; and
- applying, by the disturbance estimator, the third command current with no noise to an MDPS.
11. The method according to claim 10, wherein controlling the steering angle comprises:
- outputting, by a steering angle control unit, a command speed by compensating for the steering angle error that is a difference between the command steering angle and the current steering angle;
- outputting, by the steering angle control unit, a first command current by compensating for a speed error that is a difference between the command speed and a current steering angular velocity;
- high-frequency filtering, by a variable high-pass filter, the steering angle error by adjusting a cut-off frequency;
- adjusting, by a gain adjustment section, a gain of the variable high-pass filter by using at least one of a vehicle speed and the current steering angular velocity; and
- outputting, by an adjustment section, a second command current by arithmetically processing the first command current outputted from the steering angle control unit and a required current outputted from the gain adjustment section.
12. The method according to claim 11, wherein, in the high-frequency filtering of the steering angle error, the variable high-pass filter adjusts the cut-off frequency by adjusting a differential time of a transfer function.
13. The method according to claim 11, wherein, in the adjusting of the gain of the variable high-pass filter, the gain adjustment section adjusts the gain by multiplying a load curve gain based on the vehicle speed, the current steering angular velocity, and a preset ratio.
14. The method according to claim 11, wherein outputting the first command current comprises:
- compensating, by a position controller, for the steering angle error; and
- compensating, by a speed controller, for the speed error between a command speed outputted from the position controller and the current steering angular velocity.
15. The method according to claim 11, further comprising:
- detecting, by a vibration sensing section, vibration on the basis of the number of changes in a sign of the steering angular velocity; and
- returning, by the vibration sensing section, the cut-off frequency or the gain to an initial value according to the detected vibration.
16. The method according to claim 10, wherein removing the estimated noise in advance from the third command current outputted from the current controller and applying the third command current with no noise to the MDPS comprises:
- calculating, by an inverse transfer function unit, an inverse transfer function of the MDPS;
- applying, by the inverse transfer function unit, output of the MDPS to the inverse transfer function;
- converting, by a first variable Q-filter provided at a front terminal of the inverse transfer function unit, degrees of a numerator and a denominator of the inverse transfer function to be equal to each other;
- calculating, by a noise estimation unit, a noise estimate by subtracting output of a second variable Q-filter provided in parallel to an input terminal of the MDPS from a multiplication result of the inverse transfer function unit and the first variable Q-filter;
- subtracting, by a noise removal unit, the noise estimate from the third command current; and
- applying, by the noise removal unit, a subtraction result to the MDPS.
17. The method according to claim 16, wherein the first variable Q-filter and the second variable Q-filter are low-pass filters.
18. The method according to claim 17, wherein the low-pass filter adjusts a cut-off frequency according to a current steering angular velocity.
Type: Application
Filed: Oct 1, 2021
Publication Date: May 12, 2022
Patent Grant number: 11794804
Applicant: HYUNDAI MOBIS CO., LTD. (Seoul)
Inventor: Tae Hong KIM (Yongin-si)
Application Number: 17/492,239