Direct drive motor sliding mode control method and device
By calculating parameters such as motor status data and inertial load difference coefficients, the delay coefficient is obtained and controlled in advance, the delay problem of the sliding mode control system of the direct drive motor is solved when the irregular movement of the end effector position is irregular, and the control accuracy is improved .
Patent Information
- Application Number
- CN202411465914.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-10-21
- Publication Date
- 2024-11-19
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
The sliding mode control system of the direct drive motor has a delay phenomenon when controlling movement, especially when the position of the end effector is not regular, it is difficult for traditional methods to adjust accurately and flexibly, affecting precise control.
By obtaining the action sequence of the end effector, the status data of the sliding mode control system and the direct drive motor, the resistance increase coefficient, the variable coupling change coefficient, the inertial load difference coefficient and the maintenance time interval coefficient are calculated, and the delay coefficient is obtained based on the delay The coefficients and corresponding tables calculate the advance control time to realize advance control of the direct drive motor.
It effectively reduces the delay in the movement of the end effector and improves the degree of precise control, so that the sliding mode control system can be adjusted in time according to actual use, and enhances the precise control of the end effector.
Smart Images

Figure CN118984099A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of direct drive motor control, and in particular to a direct drive motor sliding mode control method and device. Background Art
[0002] The direct-drive motor sliding mode control system is a control system that uses a sliding mode control strategy to achieve the movement of a direct-drive motor. A direct-drive motor is a motor that converts electrical energy directly into mechanical energy. It is characterized by a simple structure, fast response speed, and high precision. Therefore, it is widely used in some equipment that requires fast response and high-precision position control, such as industrial robots. By installing a direct-drive motor inside the industrial robot to drive the robot's various joints, the robot's end effector can move precisely in space. The direct-drive motor sliding mode control system drives the direct-drive motor to move by designing a sliding mode control strategy, thereby driving the industrial robot to respond quickly and perform high-precision position control.
[0003] When controlling the movement of a direct-drive motor, a delay may occur in the sliding mode control system of the direct-drive motor. Traditional methods usually use optimization algorithms to reduce the delay between the sliding mode control system and the direct-drive motor. However, when the position movement of the end effector of the equipment is irregular, these traditional methods may not be able to accurately and flexibly make timely adjustments based on the actual use of the end effector, resulting in a delay in the movement of the end effector when the sliding mode control system controls the movement of the direct-drive motor, which may affect the precise control of the end effector. Summary of the invention
[0004] The purpose of the present invention is to solve the problem that when the sliding mode control system controls the movement of the direct-drive motor, there is still a delay in the movement of the end effector, which may affect the precise control of the end effector, and a direct-drive motor sliding mode control method and device are proposed.
[0005] In a first aspect of the present invention, a direct drive motor sliding mode control method is first proposed, the method comprising: Acquire a time-based action sequence to be performed by the end effector, and calculate the time difference between adjacent actions in the action sequence to obtain a time difference sequence; Acquire first state data between the sliding mode control system and the direct drive motor when the end effector performs the current action, and obtain a first state coefficient according to the first state data; the first state data includes a resistance increase coefficient and a variable coupling change coefficient; Acquire second state data between the direct drive motor and the end controller when the end effector performs the current action, and obtain a second state coefficient according to the second state data; the second state data includes an inertia load difference coefficient and a maintenance time interval coefficient; Obtaining a delay coefficient according to the first state coefficient and the second state coefficient, and obtaining a delay time between the current sliding mode control system and the next action according to the delay coefficient and a corresponding delay coefficient correspondence table; The difference between the delay time and the corresponding time difference in the time difference sequence is calculated to obtain the advance control time, and the sliding mode control system performs advance control on the direct drive motor according to the advance control time.
[0006] Optionally, the method for obtaining the resistance increase coefficient includes: The resistance of the direct drive motor when it starts to control the end effector is obtained multiple times, and the average value is calculated to obtain the initial resistance; The resistance of the direct-drive motor in the current time period is obtained multiple times, and the average value thereof is calculated to obtain a measured resistance, and the measured resistance is filtered to obtain a filtered resistance; Obtain the actual temperature of the direct drive motor at the current moment, and obtain the final resistance based on the actual temperature, the preset reference temperature and the filtered resistance; The difference between the final resistance and the initial resistance is calculated, and the difference is divided by the initial resistance to obtain a resistance increase coefficient.
[0007] Optionally, the method for obtaining the variable coupling variation coefficient includes: Obtain all the two-to-two related state parameters of the direct drive motors during the current running time of the sliding mode control system to obtain several state parameter groups; Obtaining corresponding data of each state parameter group based on the current running time to obtain time series data of the state parameter group; the time series data includes a plurality of groups of two related state parameters corresponding to each other; Calculate the mean and the sum of squares of the difference of each state parameter in the time series data to obtain the correlation coefficient of the state parameter group; Divide the correlation coefficient of the state parameter group by the number of state parameter groups in the time series data to obtain the variable coupling change coefficient of the state parameter group; Calculate the variable coupling variation coefficient of each state parameter group, and add the calculated results to obtain the variable coupling variation coefficient.
[0008] Optionally, obtaining a first state coefficient according to the first state data includes: The resistance increase coefficient and the variable coupling change coefficient are weighted and summed to obtain the first state coefficient. The specific formula is as follows:
[0009] In the formula, is the first state coefficient, and are the resistance increase coefficient and the variable coupling change coefficient, represent the proportionality coefficients of the resistance increase coefficient and the variable coupling change coefficient, respectively, and Both are greater than 0.
[0010] Optionally, the method for obtaining the inertia load difference coefficient is: Obtain the current running time of the end effector and the actual inertia load sequence of the direct drive motor based on time, calculate the difference between each data in the actual inertia load sequence and the preset inertia load, and add all the differences to obtain the initial inertia load difference value; Obtain the number of data in the actual inertia load sequence, and divide the initial inertia load difference coefficient by the number of loads to obtain the average inertia load difference value; Divide the average inertia load difference value by the preset inertia load to obtain the inertia load difference coefficient.
[0011] Optionally, the method for obtaining the maintenance time interval coefficient is: Obtaining the actual maintenance interval of the terminal controller, and dividing the actual maintenance interval by the preset maintenance time interval to obtain a basic maintenance time interval coefficient; Obtain the actual running time and number of running faults of the terminal controller during operation, and divide the actual running time by the number of running faults to obtain the fault frequency factor; Multiply the failure frequency factor by the basic maintenance time interval factor to obtain the maintenance time interval factor.
[0012] Optionally, obtaining a second state coefficient according to the second state data includes: The inertia load difference coefficient and the maintenance time interval coefficient are weighted and summed to obtain the second state coefficient. The specific formula is as follows:
[0013] In the formula, is the second state coefficient, and are the inertia load difference coefficient and the maintenance time interval coefficient, denote the proportionality coefficients of the inertia load difference coefficient and the maintenance time interval coefficient, respectively, and Both are greater than 0.
[0014] Optionally, obtaining a delay coefficient according to the first state coefficient and the second state coefficient, and obtaining a delay time between the current sliding mode control system and the next action according to the delay coefficient and a corresponding delay coefficient correspondence table includes: The first state coefficient and the second state coefficient are weighted and summed to obtain the delay coefficient. The specific formula is:
[0015] In the formula, is the delay coefficient, and are the first state coefficient and the second state coefficient respectively, denote the proportionality coefficients of the first state coefficient and the second state coefficient, respectively, and All are greater than 0; The delay coefficient is matched with the corresponding delay coefficient correspondence table to obtain the delay time between the current sliding mode control system and the next action.
[0016] In a second aspect of the present invention, a direct drive motor sliding mode control device is provided, the device comprising: Time difference module: obtains the time-based action sequence to be performed by the end effector, and calculates the time difference between adjacent actions in the action sequence to obtain a time difference sequence; The first state module is used to obtain the first state data between the sliding mode control system and the direct drive motor when the end effector performs the current action, and obtain the first state coefficient according to the first state data; the first state data includes the resistance increase coefficient and the variable coupling change coefficient; The second state module is used to obtain the second state data between the direct drive motor and the end controller when the end effector performs the current action, and obtain the second state coefficient according to the second state data; the second state data includes the inertia load difference coefficient and the maintenance time interval coefficient; Delay time module: obtain a delay coefficient according to the first state coefficient and the second state coefficient, and obtain the delay time between the current sliding mode control system and the next action according to the delay coefficient and the corresponding delay coefficient correspondence table; Advance control module: calculates the difference between the delay time and the corresponding time difference in the time difference sequence to obtain the advance control time, and the sliding mode control system performs advance control on the direct drive motor according to the advance control time.
[0017] Beneficial effects of the present invention: The present invention proposes a direct-drive motor sliding mode control method and device. When the position movement of the end effector of the equipment is irregular, it can accurately and flexibly make timely adjustments according to the actual use of the end effector, so that when the sliding mode control system controls the movement of the direct-drive motor, the movement of the end effector still has a small delay, thereby enhancing the precision control of the end effector. BRIEF DESCRIPTION OF THE DRAWINGS
[0018] The present invention will be further described below in conjunction with the accompanying drawings.
[0019] Figure 1 A flow chart of a direct drive motor sliding mode control method provided by an embodiment of the present invention; Figure 2 A framework diagram of a direct-drive motor sliding mode control device provided in an embodiment of the present invention. DETAILED DESCRIPTION
[0020] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0021] Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in the field without making any creative work shall fall within the scope of protection of the present invention.
[0022] The embodiment of the present invention provides a sliding mode control method for a direct drive motor. Figure 1 , Figure 1 A flow chart of a direct drive motor sliding mode control method provided by an embodiment of the present invention. The method comprises the following steps: Obtain a time-based action sequence to be performed by the end effector, and calculate the time difference between adjacent actions in the action sequence to obtain a time difference sequence; Acquire first state data between the sliding mode control system and the direct drive motor when the end effector performs the current action, and obtain a first state coefficient according to the first state data; Acquire the second state data between the direct drive motor and the end controller when the end effector performs the current action, and obtain the second state coefficient according to the second state data; Obtaining a delay coefficient according to the first state coefficient and the second state coefficient, and obtaining a delay time between the current sliding mode control system and the next action according to the delay coefficient and a corresponding delay coefficient correspondence table; The difference between the delay time and the corresponding time difference in the time difference sequence is calculated to obtain the advance control time, and the sliding mode control system performs advance control on the direct drive motor according to the advance control time.
[0023] Based on a direct-drive motor sliding mode control method provided in an embodiment of the present invention, through the above-mentioned method, when the position movement of the end effector of the equipment is irregular, it can be accurately and flexibly adjusted in time according to the actual use of the end effector, so that when the sliding mode control system controls the movement of the direct-drive motor, the movement of the end effector still has a small delay, thereby enhancing the degree of precise control of the end effector.
[0024] In one embodiment, the first status data includes: The resistance of the direct drive motor when it starts to control the end effector is obtained multiple times, and the average value is calculated to obtain the initial resistance; The calculation formula is: ; In the formula, is the initial resistance, is the number of measurements, For the The initial resistance value of the first measurement; The resistance of the direct drive motor in the current time period is obtained multiple times, and the average value thereof is calculated to obtain the measured resistance, and the measured resistance is filtered to obtain the filtered resistance; The calculation formula is: ; In the formula, is the resistance after filtering; is the size of the filter window, Indicates the current time period The resistance measured at the time; Obtain the actual temperature of the direct drive motor at the current moment, and obtain the final resistance based on the actual temperature, the preset reference temperature and the filtered resistance; The calculation formula is: ; In the formula, is the final resistance, is the temperature coefficient of resistance, is the actual temperature, is the preset reference temperature; Calculate the difference between the final resistance and the initial resistance, and divide the difference by the initial resistance to obtain the resistance increase factor; The calculation formula is:
[0025] It should be noted that the resistance of the direct-drive motor when it starts to control the end effector can be directly obtained through a motor tester or a multi-function electrical parameter measuring instrument, etc., and the details will not be repeated here; the resistance of the direct-drive motor in the current time period can be obtained by the voltage sensor and current sensor in the direct-drive motor to obtain the corresponding current and voltage and calculate the corresponding resistance, and the details will not be repeated here; It should be noted that the measured resistance can be filtered by using techniques such as Kalman filtering and moving average filtering, which will not be described in detail. By filtering the measured resistance, noise and measurement errors can be effectively reduced, providing more reliable and accurate resistance measurement results, which helps to more accurately determine the state of the motor. It should be noted that the actual temperature of the direct-drive motor can be obtained according to the temperature sensor in the direct-drive motor. In addition, the preset reference temperature is set by professionals according to the actual situation and can be obtained from the motor data manual of the direct-drive motor. The specific details will not be repeated here. The resistance temperature coefficient represents the proportional coefficient of the resistance changing with temperature, and can also be obtained from the motor data manual of the direct-drive motor. The specific details will not be repeated here. It should be noted that the larger the resistance increase factor, the greater the delay between the sliding mode control system and the direct drive motor, because the resistance increase factor reflects the change ratio of the motor winding resistance relative to its initial value. The increase in resistance often means increased losses inside the motor, increased temperature, and reduced motor efficiency, which directly affect the dynamic performance and response speed of the motor.
[0026] In one implementation, the resistance increase coefficient obtained by the above method is more accurate and can more accurately reflect the operating status between the sliding mode control system and the direct drive motor.
[0027] In one embodiment, the first status data includes: Obtain all the two-to-two related state parameters of the direct drive motors during the current running time of the sliding mode control system to obtain several state parameter groups; Obtain corresponding data of each state parameter group based on the current running time to obtain time series data of the state parameter group; the time series data includes several groups of two related state parameters corresponding to each other; Calculate the mean and sum of squares of the difference of each state parameter in the time series data to obtain the correlation coefficient of the state parameter group; The specific calculation formula is:
[0028] In the formula, Respectively represent the two state parameters of the state parameter group, and They are state parameters and In the The value at each time point; express and The correlation coefficient between Divide the correlation coefficient of the state parameter group by the number of state parameter groups in the time series data to obtain the variable coupling change coefficient of the state parameter group; Calculate the variable coupling variation coefficient of each state parameter group, and add the calculated results to obtain the variable coupling variation coefficient.
[0029] It should be noted that the two related state parameters can be any two related state parameters in the system; for example, the speed and torque, current and voltage, temperature and operating time of the direct-drive motor, etc., which are specifically set by professionals and are not specifically limited; and the specific state parameters can be obtained through corresponding sensors or the monitoring system of the sliding mode control system, and the details will not be elaborated.
[0030] It should be noted that the larger the variable coupling increase coefficient is, the greater the degree of coupling between the variables in the system is, which may lead to a decrease in the real-time performance of the sliding mode control system in controlling the movement of the direct-drive motor, and the possibility of increased delay will also increase; when there is a high coupling between the variables in the system, the change of one variable may have a greater impact on other variables, causing the control system to respond slowly to changes. Therefore, a larger variable coupling increase coefficient may cause the dynamic response of the control system to slow down, thereby reducing the real-time performance of the system and increasing the delay of the movement; at the same time, the increase in variable coupling will introduce more interference and nonlinear effects, making it difficult for the sliding mode control system to accurately control the direct-drive motor, resulting in a decrease in control accuracy.
[0031] In one implementation, through the above method, the calculated variable coupling change coefficient is more accurate and can more accurately reflect the operating status between the sliding mode control system and the direct drive motor.
[0032] In one embodiment, obtaining the first state coefficient according to the first state data includes: The resistance increase coefficient and the variable coupling change coefficient are weighted and summed to obtain the first state coefficient. The specific formula is as follows:
[0033] In the formula, is the first state coefficient, and are the resistance increase coefficient and the variable coupling change coefficient, represent the proportionality coefficients of the resistance increase coefficient and the variable coupling change coefficient, respectively, and All are greater than 0; In one implementation, the first state coefficient obtained by the above method is more accurate and can more accurately reflect the operating state between the sliding mode control system and the direct drive motor.
[0034] It should be noted that the reason why the resistance increase coefficient and the variable coupling change coefficient are selected to calculate the operating state coefficient of the delay between the sliding mode control system and the direct drive motor instead of other data is that considering the resistance increase coefficient and the variable coupling change coefficient can give a more comprehensive understanding of the operating state of the system, because they reflect the dynamic characteristics and coupling degree of the system from the two aspects of internal mechanism and overall system performance. Therefore, choosing these two indicators to calculate the delayed operating state coefficient can more accurately evaluate the delay between the sliding mode control system and the direct drive motor.
[0035] In one embodiment, the second status data includes: Obtain the current running time of the end effector and the actual inertia load sequence of the direct drive motor based on time, calculate the difference between each data in the actual inertia load sequence and the preset inertia load, and add all the differences to obtain the initial inertia load difference value; Obtain the number of data in the actual inertia load sequence, and divide the initial inertia load difference coefficient by the number of loads to obtain the average inertia load difference value; Divide the average inertia load difference value by the preset inertia load to obtain the inertia load difference coefficient; It should be noted that the actual inertial load of the direct-drive motor can be measured in real time by an inertial sensor or an acceleration sensor inside the direct-drive motor, and the details will not be repeated here.
[0036] It should be noted that the larger the inertia load difference coefficient, the greater the delay between the direct drive motor and the end controller. A larger inertia load difference coefficient indicates that there is a significant difference between the actual load and the preset load, which will cause the system to take more time to adjust when responding to load changes, thereby increasing the delay of the control system. The specific reasons are as follows: Increased dynamic response time: When the actual load deviates significantly from the preset load, the motor takes more time to reach a steady state because the system needs to adjust more energy to overcome the additional inertia.
[0037] Increased controller compensation requirements: To maintain precise control, sliding mode control systems need to adjust control signals more frequently to compensate for load changes. This frequent adjustment increases the computational and response burden of the system, resulting in longer overall response times.
[0038] Increased mechanical and electrical stress: Significant changes in inertial loads increase mechanical and electrical stress on the motor and drive system, potentially leading to more frequent current and voltage adjustments that introduce additional delays.
[0039] Error accumulation effect: The difference between the actual load and the preset load will lead to the accumulation of control errors. The controller needs to spend more time and resources to correct these errors, thus prolonging the response time of the system.
[0040] In one implementation, through the above method, the more accurate the calculated inertial load difference coefficient of the direct-drive motor is, the more it can reflect the degree of delay between the direct-drive motor and the end effector.
[0041] In one embodiment, the second status data includes: Obtaining the actual maintenance interval of the terminal controller, and dividing the actual maintenance interval by the preset maintenance time interval to obtain a basic maintenance time interval coefficient; Obtain the actual running time and number of running faults of the terminal controller during operation, and divide the actual running time by the number of running faults to obtain the fault frequency factor; Multiply the fault frequency factor by the basic maintenance time interval coefficient to obtain the maintenance time interval coefficient; In one implementation, through the above method, the calculated maintenance time interval coefficient is more accurate and can more accurately reflect the degree of delay between the direct drive motor and the end effector.
[0042] It should be noted that the actual maintenance interval can be obtained based on the work log of the terminal controller, or by other means, without any specific limitation; the actual operating time and number of operating failures of the terminal controller during operation can also be obtained based on the work log of the terminal controller, or by other means, without any specific limitation; the preset maintenance time interval is set by professionals based on actual conditions, without any specific limitation.
[0043] It should be noted that a larger maintenance interval coefficient of the end effector may indicate a larger delay between the direct drive motor and the end controller; the reasons are as follows: Reduced maintenance frequency: A larger maintenance interval factor means that the system has not been maintained or repaired for a longer period of time. Over time, the various components of the system (including direct drive motors, sensors, controllers, etc.) may experience wear, aging, or performance degradation. These problems will cause the system to respond less quickly and increase control delays.
[0044] Cumulative effect of failures: Long periods of time without maintenance may lead to the accumulation of minor failures. Although these minor failures may not have a significant impact on system performance individually, they can significantly affect the overall performance and response time of the system when accumulated. For example, problems such as decreased sensor accuracy, increased friction due to lubricant failure, and loose electrical connections can all lead to increased delays.
[0045] Parameter drift: Certain parameters of the direct drive motor and control system (such as gain, inertia, damping, etc.) may drift after long-term operation. If not adjusted and corrected in time, these parameter drifts will cause inaccurate models of the control system, thereby increasing the response time and delay of the control system.
[0046] Accumulated errors and drift: During long-term operation, systems that are not maintained in time will accumulate more errors and drift, making it difficult for the control algorithm to accurately predict and control system behavior. This will increase the calculation and adjustment burden of the control system, thereby increasing response delays.
[0047] In one embodiment, obtaining the second state coefficient according to the second state data includes: The inertia load difference coefficient and the maintenance time interval coefficient are weighted and summed to obtain the second state coefficient. The specific formula is as follows:
[0048] In the formula, is the second state coefficient, and are the inertia load difference coefficient and the maintenance time interval coefficient, denote the proportionality coefficients of the inertia load difference coefficient and the maintenance time interval coefficient, respectively, and All are greater than 0; In one implementation, the second state coefficient obtained by the above method is more accurate and can more accurately reflect the operating state between the direct drive motor and the die forging actuator.
[0049] It should be noted that selecting the inertial load difference coefficient and the maintenance time interval coefficient as the operating state coefficients for calculating the delay can reflect the dynamic changes and stability status within the system, thereby more comprehensively evaluating the delay between the direct-drive motor and the end effector.
[0050] In one embodiment, obtaining a delay coefficient according to the first state coefficient and the second state coefficient, and obtaining the delay time between the current sliding mode control system and the next action according to the delay coefficient and the corresponding delay coefficient correspondence table includes: The first state coefficient and the second state coefficient are weighted and summed to obtain the delay coefficient. The specific formula is:
[0051] In the formula, is the delay coefficient, and are the first state coefficient and the second state coefficient respectively, denote the proportionality coefficients of the first state coefficient and the second state coefficient, respectively, and All are greater than 0; The delay coefficient is matched with the corresponding delay coefficient correspondence table to obtain the delay time between the current sliding mode control system and the next action.
[0052] It should be noted that the corresponding delay coefficient correspondence table is set by professionals according to actual conditions, and the details are not repeated here.
[0053] In one implementation, through the above method, the data of the delay time of the current sliding mode control system and the next action obtained are more accurate and can more truly reflect the delay time.
[0054] In one embodiment, the difference between the delay time and the corresponding time difference in the time difference sequence is calculated to obtain the advance control time, and the sliding mode control system controls the direct drive motor according to the advance control time, including: Calculate the difference between the delay time and the corresponding time difference in the time difference sequence to obtain the advance control time. For example, assuming that the end effector is performing the current action, the delay time between the sliding mode control system and the end effector is calculated to be 0.5s, and the time difference from the current action to the next action is 1s. At this time, in order to accurately control the direct drive motor to drive the end effector to move accurately, the sliding mode control system needs to issue a command 0.5s in advance to control the direct drive motor movement to drive the end effector to move accurately.
[0055] It should be noted that the delay time mentioned above will not be greater than or equal to the time interval between adjacent actions of the end effector, because in the actual operation scenario, the delay time between the sliding mode control system and the end effector is small, much smaller than the time interval between adjacent actions of the end effector. This is because the response speed of modern control systems is usually very fast, and the control instructions can be quickly transmitted to the direct drive motor, and the response speed of the direct drive motor is also very high. Therefore, the control instructions issued by the sliding mode control system can often arrive before the end effector starts to perform the next action and be executed within a reasonable time range.
[0056] Based on the same inventive concept, the present invention also provides a direct drive motor sliding mode control device. Figure 2 , Figure 2 A framework diagram of a direct drive motor sliding mode control device provided by an embodiment of the present invention includes: Time difference module: obtains the time-based action sequence to be performed by the end effector, and calculates the time difference between adjacent actions in the action sequence to obtain the time difference sequence; The first state module is used to obtain the first state data between the sliding mode control system and the direct drive motor when the end effector performs the current action, and obtain the first state coefficient according to the first state data; the first state data includes the resistance increase coefficient and the variable coupling change coefficient; The second state module is used to obtain the second state data between the direct drive motor and the end controller when the end effector performs the current action, and obtain the second state coefficient according to the second state data; Delay time module: obtain the delay coefficient according to the first state coefficient and the second state coefficient, and obtain the delay time of the current sliding mode control system and the next action according to the delay coefficient and the corresponding delay coefficient correspondence table; Advance control module: Calculate the difference between the delay time and the corresponding time difference in the time difference sequence to obtain the advance control time. The sliding mode control system performs advance control on the direct drive motor according to the advance control time.
[0057] Based on a direct-drive motor sliding mode control device provided in an embodiment of the present invention, through the above-mentioned method, when the position movement of the end effector of the equipment is irregular, it can be accurately and flexibly adjusted in time according to the actual use of the end effector, so that when the sliding mode control system controls the movement of the direct-drive motor, the movement of the end effector still has a small delay, thereby enhancing the precision of control of the end effector.
[0058] The above is a detailed description of an embodiment of the present invention, but the content is only a preferred embodiment of the present invention and cannot be considered to limit the scope of implementation of the present invention. All equivalent changes and improvements made within the scope of the present invention should still fall within the scope of the patent coverage of the present invention.
Claims
1. A direct drive motor sliding mode control method, characterized in that: The following steps are involved: Acquire a time-based action sequence to be performed by the end effector, and calculate the time difference between adjacent actions in the action sequence to obtain a time difference sequence; Acquire first state data between the sliding mode control system and the direct drive motor when the end effector performs the current action, and obtain a first state coefficient according to the first state data; the first state data includes a resistance increase coefficient and a variable coupling change coefficient; Acquire second state data between the direct drive motor and the end controller when the end effector performs the current action, and obtain a second state coefficient according to the second state data; the second state data includes an inertia load difference coefficient and a maintenance time interval coefficient; Obtaining a delay coefficient according to the first state coefficient and the second state coefficient, and obtaining a delay time between the current sliding mode control system and the next action according to the delay coefficient and a corresponding delay coefficient correspondence table; The difference between the delay time and the corresponding time difference in the time difference sequence is calculated to obtain the advance control time, and the sliding mode control system performs advance control on the direct drive motor according to the advance control time.
2. A direct drive motor sliding mode control method according to claim 1, characterized in that: The method for obtaining the resistance increase coefficient includes: The resistance of the direct drive motor when it starts to control the end effector is obtained multiple times, and the average value is calculated to obtain the initial resistance; The resistance of the direct-drive motor in the current time period is obtained multiple times, and the average value thereof is calculated to obtain a measured resistance, and the measured resistance is filtered to obtain a filtered resistance; Obtain the actual temperature of the direct drive motor at the current moment, and obtain the final resistance based on the actual temperature, the preset reference temperature and the filtered resistance; The difference between the final resistance and the initial resistance is calculated, and the difference is divided by the initial resistance to obtain a resistance increase coefficient.
3. A direct drive motor sliding mode control method according to claim 1, characterized in that: The method for obtaining the variable coupling variation coefficient comprises: Obtain all the two-to-two related state parameters of the direct drive motors during the current running time of the sliding mode control system to obtain several state parameter groups; Obtaining corresponding data of each state parameter group based on the current running time to obtain time series data of the state parameter group; the time series data includes a plurality of groups of two related state parameters corresponding to each other; Calculate the mean and the sum of squares of the difference of each state parameter in the time series data to obtain the correlation coefficient of the state parameter group; Divide the correlation coefficient of the state parameter group by the number of state parameter groups in the time series data to obtain the variable coupling change coefficient of the state parameter group; Calculate the variable coupling variation coefficient of each state parameter group, and add the calculated results to obtain the variable coupling variation coefficient.
4. A direct drive motor sliding mode control method according to claim 1, characterized in that: Obtaining a first state coefficient according to the first state data includes: The resistance increase coefficient and the variable coupling change coefficient are weighted and summed to obtain the first state coefficient. The specific formula is as follows: In the formula, is the first state coefficient, and are the resistance increase coefficient and the variable coupling change coefficient, represent the proportionality coefficients of the resistance increase coefficient and the variable coupling change coefficient, respectively, and Both are greater than 0.
5. A direct drive motor sliding mode control method according to claim 1, characterized in that: The method for obtaining the inertia load difference coefficient is: Obtain the current running time of the end effector and the actual inertia load sequence of the direct drive motor based on time, calculate the difference between each data in the actual inertia load sequence and the preset inertia load, and add all the differences to obtain the initial inertia load difference value; Obtain the number of data in the actual inertia load sequence, and divide the initial inertia load difference coefficient by the number of loads to obtain the average inertia load difference value; Divide the average inertia load difference value by the preset inertia load to obtain the inertia load difference coefficient.
6. A direct drive motor sliding mode control method according to claim 1, characterized in that: The method for obtaining the maintenance time interval coefficient is: Obtaining the actual maintenance interval of the terminal controller, and dividing the actual maintenance interval by the preset maintenance time interval to obtain a basic maintenance time interval coefficient; Obtain the actual running time and number of running faults of the terminal controller during operation, and divide the actual running time by the number of running faults to obtain the fault frequency factor; Multiply the failure frequency factor by the basic maintenance time interval factor to obtain the maintenance time interval factor.
7. A direct drive motor sliding mode control method according to claim 1, characterized in that: Obtaining a second state coefficient according to the second state data includes: The inertia load difference coefficient and the maintenance time interval coefficient are weighted and summed to obtain the second state coefficient. The specific formula is as follows: In the formula, is the second state coefficient, and are the inertia load difference coefficient and the maintenance time interval coefficient, denote the proportionality coefficients of the inertia load difference coefficient and the maintenance time interval coefficient, respectively, and Both are greater than 0.
8. A direct drive motor sliding mode control method according to claim 1, characterized in that: Obtaining a delay coefficient according to the first state coefficient and the second state coefficient, and obtaining a delay time between the current sliding mode control system and the next action according to the delay coefficient and a corresponding delay coefficient correspondence table includes: The first state coefficient and the second state coefficient are weighted and summed to obtain the delay coefficient. The specific formula is: In the formula, is the delay coefficient, and are the first state coefficient and the second state coefficient respectively, denote the proportionality coefficients of the first state coefficient and the second state coefficient, respectively, and All are greater than 0; The delay coefficient is matched with the corresponding delay coefficient correspondence table to obtain the delay time between the current sliding mode control system and the next action.
9. A direct drive motor sliding mode control method and device, characterized in that: The device comprises: Time difference module: obtains the time-based action sequence to be performed by the end effector, and calculates the time difference between adjacent actions in the action sequence to obtain a time difference sequence; The first state module is used to obtain the first state data between the sliding mode control system and the direct drive motor when the end effector performs the current action, and obtain the first state coefficient according to the first state data; the first state data includes the resistance increase coefficient and the variable coupling change coefficient; The second state module is used to obtain the second state data between the direct drive motor and the end controller when the end effector performs the current action, and obtain the second state coefficient according to the second state data; the second state data includes the inertia load difference coefficient and the maintenance time interval coefficient; Delay time module: obtain a delay coefficient according to the first state coefficient and the second state coefficient, and obtain the delay time between the current sliding mode control system and the next action according to the delay coefficient and the corresponding delay coefficient correspondence table; Advance control module: calculates the difference between the delay time and the corresponding time difference in the time difference sequence to obtain the advance control time, and the sliding mode control system performs advance control on the direct drive motor according to the advance control time.
Citation Information
Patent Citations
Motor position servo system control method taking input time lag into consideration
CN104111607A
Finite-time continuous sliding mode control method for disturbance compensation of direct drive motor system
CN105159077A
Inchworm-imitating movement driving device of magnetic soft-bodied robot
CN112809661A
Self-adaptive sliding mode control method for end effector of wire harness winding robot
CN115202208A
Motor driving intelligent regulation and control method and system
CN117792219A
