Control method and device for controlled device, and storage medium
By calculating the correct elastic coefficient and driving force of the transmission device, determining the speed and speed difference, and accurately controlling the controlled device, the problems of low delay and accuracy in power drive control are solved, and high-precision position, force and speed control are achieved. Reduced costs and development cycles.
Patent Information
- Application Number
- PCT/CN2023/097648
- Authority / Receiving Office
- WO · WO
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-05-31
- Publication Date
- 2024-12-05
AI Technical Summary
In power drive control, due to the elasticity of the transmission device, the output of the driving force is delayed, resulting in the force of the controlled device not equal to the driving force, and there is a deviation between the speed and the speed, which in turn affects the control accuracy. The prior art relies on multiple sensor measurements, resulting in low accuracy and high cost, and the inability to achieve precise control.
By obtaining the correct elastic coefficient of the moving parts in the transmission device and the driving force of the drive device, calculating the speed difference value and rotation speed difference value, determining the deformation amount and transmission force, using these precise data for control of the controlled device, reducing the use of sensors, and improving the use of the sensor Control accuracy.
It improves the control accuracy of the controlled device, reduces sensor usage and cost, simplifies control system design, and shortens development cycle.
Smart Images

Figure CN2023097648_05122024_PF_FP_ABST
Abstract
Description
Control method, device and storage medium for controlled device Technical Field
[0001] The present application relates to the field of power drive control, and in particular to a control method, device and storage medium for a controlled device. Background Art
[0002] In the field of power drive control, especially for the control of changing loading forces, due to the elasticity of the transmission device, there is a time delay in the transmission of the driving force output from the driving device to the force exerted on the controlled device, resulting in the force exerted on the controlled device not being completely equal to the driving force of the driving device under the changing loading force. At this time, there is a deviation between the speed of the driving device and the speed of the controlled device. If these deviations are not compensated, the control accuracy of the controlled device will be low and the control effect will be poor.
[0003] Currently, to ensure precise position, force, and speed control of controlled devices, related technologies typically measure the force transmission process and the motion states of the driving and controlled devices one by one. However, this approach still suffers from low precision in the measured variables, making it difficult to precisely control the controlled device.
[0004] Summary of the Invention
[0005] Embodiments of the present application provide a control method, device, and storage medium for a controlled device, for improving the accuracy of controlling the controlled device.
[0006] In a first aspect, an embodiment of the present application provides a control method for a controlled device, comprising: obtaining a corrected elastic coefficient of a moving part in a transmission device and a driving force of a driving device; determining a speed difference between a first speed of the driving device and a second speed of the controlled device, as well as a speed difference between a first rotational speed of the driving device and a second rotational speed of the controlled device based on the corrected elastic coefficient and the driving force; determining a deformation amount of the transmission device based on the speed difference or the rotational speed difference; obtaining a first speed and a first rotational speed, and determining a second speed based on the first speed and the speed difference, and determining a second rotational speed based on the first rotational speed and the rotational speed difference; determining a transmission force of the transmission device based on the corrected elastic coefficient and the deformation; and controlling the movement of the controlled device based on at least one of the deformation amount, speed difference, rotational speed difference, second speed, second rotational speed and transmission force.
[0007] In one possible implementation, obtaining a corrected elastic coefficient of a moving component in a transmission device includes: obtaining a target speed ratio of the transmission device at a preset speed level, and a target elastic coefficient of the transmission device at the target speed ratio; and determining the corrected elastic coefficient based on the target speed ratio and the target elastic coefficient.
[0008] In one possible implementation, determining a speed difference between a first speed of the driving device and a second speed of the controlled device based on a corrected elastic coefficient and a driving force includes: obtaining a corrected mass of moving parts in the driving device and the transmission device; and determining the speed difference based on the corrected mass, the corrected elastic coefficient, and the driving force.
[0009] In one possible embodiment, the speed difference between the first speed of the driving device and the second speed of the controlled device is determined based on the corrected elastic coefficient and the driving force, including: obtaining the corrected rotational inertia of the moving parts in the driving device and the transmission device; and determining the speed difference based on the corrected rotational inertia, the corrected elastic coefficient and the driving force.
[0010] In one possible implementation, determining the deformation of the transmission device based on the speed difference or the rotational speed difference includes: determining a first integral value of the speed difference; determining the first integral value as the deformation; or, determining a second integral value of the rotational speed difference; determining the second integral value as the deformation.
[0011] In a possible implementation, determining the second speed according to the first speed and the speed difference includes: determining a first difference between the first speed and the speed difference; and determining the second speed according to a third ratio of the first difference to a total speed ratio of the transmission.
[0012] In a possible implementation, determining the second speed based on the first speed and the speed difference includes: determining a second difference between the first speed and the speed difference; and determining the second speed based on the second difference and a fourth ratio of the total speed ratio of the transmission.
[0013] In a possible implementation, determining the transmission force of the transmission device according to the modified elastic coefficient and the deformation includes: obtaining a third product of the modified elastic coefficient and the deformation; and determining the transmission force according to the third product.
[0014] In a second aspect, an embodiment of the present application provides a control device for a controlled device, comprising: an acquisition module for acquiring a corrected elastic coefficient of a moving part in a transmission device and a driving force of a driving device; a first determination module for determining a speed difference between a first speed of the driving device and a second speed of the controlled device, as well as a speed difference between a first rotational speed of the driving device and a second rotational speed of the controlled device, based on the corrected elastic coefficient and the driving force; a second determination module for determining a deformation amount of the transmission device based on the speed difference or the rotational speed difference; a third determination module for acquiring a first speed and a first rotational speed, and determining a second speed based on the first speed and the speed difference, and determining a second rotational speed based on the first rotational speed and the rotational speed difference; a fourth determination module for determining a transmission force of the transmission device based on the corrected elastic coefficient and the deformation; and a control module for controlling the movement of the controlled device based on at least one of the deformation amount, speed difference, rotational speed difference, second speed, second rotational speed and transmission force.
[0015] In a third aspect, an embodiment of the present application provides an electronic device comprising: a processor, and a memory connected to the processor; the memory stores computer-executable instructions; the processor executes the computer-executable instructions stored in the memory to implement the control method of the controlled device as in the first aspect.
[0016] In a fourth aspect, an embodiment of the present application provides a computer-readable storage medium, in which computer-executable instructions are stored. When the computer-executable instructions are executed, they are used to implement the control method of the controlled device of the first aspect.
[0017] In a fifth aspect, an embodiment of the present application provides a computer program product, including a computer program, which implements the control method of the controlled device as in the first aspect when the computer program is executed.
[0018] The control method, device and storage medium of the controlled device provided in the embodiments of the present application can calculate the speed difference and rotational speed difference between the driving device and the controlled device by obtaining the corrected elastic coefficient of the moving parts in the transmission device and the driving force of the driving device, thereby calculating the deformation of the transmission device, and calculating the speed and rotational speed of the controlled device, and determining the transmission force of the transmission device. Since the corrected elastic coefficient of the moving parts in the transmission device and the driving force of the driving device are both values measured under static conditions, the accuracy of the calculated deformation, speed, rotational speed and transmission force will be higher than the accuracy of the measured values. Therefore, by controlling the controlled device based on at least one of the calculated deformation, speed difference, rotational speed difference, speed, rotational speed and transmission force, the accuracy of controlling the controlled device can be improved. BRIEF DESCRIPTION OF THE DRAWINGS
[0019] In order to more clearly illustrate the technical solutions in the embodiments of the present application or related technologies, the following is a brief introduction to the drawings required for use in the embodiments or related technical descriptions. Obviously, the drawings described below are some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative labor.
[0020] FIG1 is a schematic structural diagram of a power drive system provided in an embodiment of the present application;
[0021] FIG2 is a flow chart of a method for controlling a controlled device according to an embodiment of the present application;
[0022] FIG3 is a schematic diagram of a curve showing the driving force of a driving device provided in an embodiment of the present application;
[0023] FIG4 is a schematic diagram showing a curve comparison of a measured speed difference and a calculated speed difference between a driving device and a controlled device provided in an embodiment of the present application;
[0024] FIG5 is a schematic diagram of a curve showing the deformation of a transmission device provided in an embodiment of the present application;
[0025] FIG6 is a schematic structural diagram of a control device for a controlled device according to an embodiment of the present application;
[0026] Fig. 7 is a block diagram of an electronic device according to an exemplary embodiment. DETAILED DESCRIPTION
[0027] To make the purpose, technical solutions, and advantages of the embodiments of the present application more clear, the technical solutions in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments made by ordinary technicians in this field based on the inspiration of these embodiments fall within the scope of protection of this application.
[0028] The terms "first", "second", "third", "fourth", etc. (if any) in the specification and claims of the present application and the above-mentioned drawings are used to distinguish similar objects and are not necessarily used to describe a specific order or sequential order. It should be understood that the numbers used in this way are interchangeable where appropriate, so that the embodiments of the present application described herein can be implemented in an order other than those illustrated or described herein. In addition, the terms "including" and "having" and any variations thereof are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device that includes a series of steps or units is not necessarily limited to those steps or units clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.
[0029] The following first explains the terms involved in this application.
[0030] Elastic modulus: the ratio of the force acting on an object to its deformation.
[0031] Driving force: The output force of the driving device.
[0032] Transmitted force: The output force of the transmission device, which is equal to the force applied to the controlled device.
[0033] Deformation of the transmission device: the change in the relative position of the driving device and the controlled device.
[0034] The related technologies provided in the background technology have at least the following technical problems:
[0035] Since various sensors are needed to measure the force transmission process during power drive control, the measurement cost is high, which has a great impact on the cost of large-scale production of drive devices; sensors need to be attached to various components. Therefore, the more sensors are used, the higher the requirements for sensor layout, the higher the technical capabilities required for assembly design, and the longer the development cycle; during the force transmission process, the data accuracy of sensors measuring many dynamic moving parts is low, making it impossible to accurately control the position, speed or force of the controlled device.
[0036] In response to the problems in the related art, the present application proposes a control method for a controlled device. By determining the elastic coefficient and speed ratio of the moving parts in the transmission device, the corrected elastic coefficient of the moving parts in the transmission device can be determined with high accuracy, and the driving force of the driving device can be obtained by sensor measurement or table lookup. Therefore, the driving force has high accuracy, and the speed difference and rotational speed difference between the driving device and the controlled device calculated in this way have high accuracy, thereby calculating the deformation of the transmission device with high accuracy, and calculating the speed and rotational speed of the controlled device with high accuracy, and determining the transmission force of the transmission device with high accuracy. Therefore, by controlling the controlled device according to at least one of the calculated deformation, speed, rotational speed and transmission force, the accuracy of controlling the controlled device can be improved, the use of sensors can be reduced, and the cost can be further reduced.
[0037] In one embodiment, the control method of the controlled device can be applied in an application scenario. Figure 1 is a schematic diagram of the structure of the power drive system provided in an embodiment of the present application. As shown in Figure 1, the power drive system may include a controller, a drive device, a transmission device, and a controlled device. The controller can control the drive device, the transmission device, and the controlled device, and the transmission device connects the drive device and the controlled device.
[0038] In the above scenario, the driving device is used to generate power, that is, driving force; the transmission device is used to transmit or interrupt power, and the transmission force of the transmission device is equal to the force applied to the controlled device; the controlled device is used to move under the action of the force; the controller is used to control the driving device and the transmission device by receiving the motion state and mechanical state of each moving part in the driving device and the transmission device, thereby achieving control of the controlled device.
[0039] Optionally, the motion state may include at least one of the following: speed, rotation speed, position, etc.; the mechanical state may include at least one of the following: magnitude of force, direction of force, deformation of the transmission device, speed ratio of the transmission device, etc.
[0040] In the above scenario, the motion state and mechanical state of each moving part in the driving device and the transmission device can be measured in a static state. The data can be measured by sensors in a static state, and other data can be calculated based on the measured data, thereby improving the accuracy of the acquired data and thus improving the accuracy of controlling the controlled device.
[0041] In combination with the above scenarios, the technical solution of the control method of the controlled device provided by this application is described in detail through several specific embodiments below.
[0042] The present application provides a method for controlling a controlled device. FIG2 is a flow chart of the method for controlling a controlled device provided in an embodiment of the present application. As shown in FIG2 , the method includes the following steps:
[0043] S201: Obtaining a modified elastic coefficient of a moving component in a transmission device and a driving force of a driving device.
[0044] In this step, the moving parts can be one or more of a tooth, a rod, a shaft, a wheel, a belt, a key, etc., that is, one of the teeth, rod, shaft, wheel, belt, key, etc. transmits the driving force alone, or multiple of them transmit the driving force simultaneously in series or parallel. The driving device can also be called a power source. The driving device can be one or more of a fuel engine, a steam engine, an electric motor, a piston, etc., that is, one of the fuel engine, steam engine, electric motor, piston, etc. provides the driving force alone, or multiple of them provide the driving force simultaneously. The driving force can be a longitudinal force and / or a rotational force, where the longitudinal force can be one or more of pressure, thrust, tension, etc., and the rotational force can be torque and / or torsional force.
[0045] Alternatively, the modified elastic coefficient can be calculated, and the driving force can be obtained by measurement or by looking up a table in a control program. The driving force of the driving device can be equal to the output force of the driving device. Therefore, the modified elastic coefficient and driving force are highly accurate. A graph of the driving force of the driving device can be shown in Figure 3. Figure 3 is a schematic diagram of a graph of the driving force of the driving device provided in an embodiment of the present application.
[0046] S202: Determine a speed difference between a first speed of the driving device and a second speed of the controlled device, and a speed difference between a first rotational speed of the driving device and a second rotational speed of the controlled device according to the corrected elastic coefficient and the driving force.
[0047] In this step, the first speed of the driving device and the second speed of the controlled device can represent linear motion of the controlled device, and the first rotational speed of the driving device and the second rotational speed of the controlled device can represent circular motion of the controlled device. By using the highly accurate corrected elastic modulus and driving force, the speed and rotational speed differences between the driving device and the controlled device can be determined with high accuracy, thereby determining the speed or rotational speed of the controlled device and the deformation of the controlled device with high accuracy, thereby facilitating high-precision control of the controlled device.
[0048] S203: Determine the deformation amount of the transmission device according to the speed difference or the rotation speed difference.
[0049] In this step, the deformation of the transmission device can represent the relative position of the driving device and the controlled device. When the controlled device is performing linear motion, this relative position can be determined by the speed difference between the driving device and the controlled device; when the controlled device is performing circular motion, this relative position can be determined by the speed difference between the driving device and the controlled device.
[0050] S204: Acquire a first speed and a first rotational speed, and determine a second speed according to the first speed and the speed difference, and determine a second rotational speed according to the first rotational speed and the rotational speed difference.
[0051] In this step, the first speed and first rotational speed of the driving device can be measured by sensors. Measuring the second speed and second rotational speed of the controlled device using sensors would increase measurement costs. Alternatively, the second speed can be determined from the first speed and a high-precision speed difference, and the second rotational speed can be determined from the first rotational speed and the rotational speed difference. This allows for high-precision control of the controlled device.
[0052] S205: Determine the transmission force of the transmission device according to the corrected elastic coefficient and the deformation amount.
[0053] In this step, the transmission device's output force equals the transmission device's transmission force. However, because the transmission device's input force experiences losses during transmission, the transmission device's input force is not equal to the transmission device's output force, and therefore, the transmission device's input force is not equal to the transmission device's transmission force. Therefore, the transmission device's transmission force can be determined by the modified elastic modulus of the transmission device's moving components and the deformation of the transmission device.
[0054] S206: Controlling the movement of the controlled device according to at least one of the deformation amount, the speed difference, the rotation speed difference, the second speed, the second rotation speed, and the transmission force.
[0055] In this step, the controlled device can be controlled to perform linear motion or circular motion by at least one of the deformation amount, speed difference, rotation speed difference, second speed, second rotation speed and transmission force.
[0056] The control method of the controlled device provided in this embodiment can calculate the speed difference and rotational speed difference between the driving device and the controlled device by obtaining the corrected elastic coefficient of the moving parts in the transmission device and the driving force of the driving device, thereby calculating the deformation of the transmission device, and calculating the speed and rotational speed of the controlled device, and determining the transmission force of the transmission device. Since the corrected elastic coefficient of the moving parts in the transmission device and the driving force of the driving device are both values measured under static conditions, the accuracy of the calculated deformation, speed, rotational speed and transmission force will be higher than the accuracy of the measured values. Therefore, by controlling the controlled device based on at least one of the calculated deformation, speed difference, rotational speed difference, speed, rotational speed and transmission force, the accuracy of controlling the controlled device can be improved.
[0057] In one embodiment, obtaining a corrected elastic coefficient of a moving component in a transmission device includes: obtaining a target speed ratio of the transmission device at a preset speed level, and a target elastic coefficient of the transmission device at the target speed ratio; and determining a corrected elastic coefficient based on the target speed ratio and the target elastic coefficient.
[0058] In this solution, for a transmission with multiple gear stages, the elastic coefficient is a modified elastic coefficient, which ignores the intermediate deformation process and only calculates the total deformation of the input and output stages of the transmission. The calculation formula can be as follows: K = K1*i1+K2*i2…+K n *i n
[0059] Among them, i n It can indicate the target speed ratio under the preset level; K n It can be expressed as the target elastic coefficient under the target speed ratio; K can be expressed as the modified elastic coefficient. n and K n It is the data that can be measured or obtained by looking up the table in static state. Therefore, the accuracy of the corrected elastic coefficient can be improved by calculating the corrected elastic coefficient through the above formula.
[0060] Optionally, a high-precision driving force and a high-precision deformation can be obtained by measuring in a static state, and a corresponding relationship between the driving force and the deformation, for example, a ratio between the driving force and the deformation, can be determined to obtain a corrected elastic coefficient.
[0061] Optionally, the modified elastic coefficient may be calibrated by curve fitting.
[0062] In one embodiment, determining a speed difference between a first speed of a driving device and a second speed of a controlled device based on a corrected elastic coefficient and a driving force includes: obtaining a corrected mass of moving parts in the driving device and the transmission device; and determining the speed difference based on the corrected mass, the corrected elastic coefficient, and the driving force.
[0063] In this scheme, for drive devices and transmission devices with multi-stage gears, the mass of their moving parts is the corrected mass, that is, the relevant parts of the transmission device are treated as lightweight springs in the calculation process. The corrected mass can be obtained through measurement under static conditions. The mass of the moving parts of the transmission device and the mass of the moving parts of the drive device are calculated after correction. The calculation formula for the corrected mass can be as follows: M = M1 / i1 + M2 / i2… + M n / i n
[0064] Among them, i n Can represent the speed ratio of the corresponding level; M n It can represent the mass of the moving parts of the transmission device and drive device under the corresponding speed ratio; M can represent the modified mass.
[0065] Specifically, after obtaining the corrected mass, the speed difference can be determined by the following formula: F 驱 -K*∫ΔV=M*ΔV
[0066] Among them, F 驱 Can represent driving force, K can represent the modified elastic coefficient, ΔV can represent the speed difference, and M can represent the modified mass. Using the highly accurate modified elastic coefficient and driving force, the speed difference between the driving device and the controlled device can be determined with high precision, thereby determining the speed and deformation of the controlled device with high precision, thereby facilitating high-precision control of the controlled device.
[0067] Optionally, the corrected mass may be obtained through the relationship between the driving force and the acceleration, or the corrected mass may be calibrated through curve fitting.
[0068] Optionally, a curve comparison of the measured speed difference and the calculated speed difference of the driving device and the controlled device can be shown in Figure 4. Figure 4 is a schematic diagram of a curve comparison of the measured speed difference and the calculated speed difference of the driving device and the controlled device provided in an embodiment of the present application. According to Figure 4, it can be seen that by comparing the calculated speed difference with the measured speed difference, it can be determined that the calculated speed difference has good accuracy, so that the force condition of the controlled device, that is, the transmission force of the transmission device, can be accurately calculated.
[0069] In one embodiment, the speed difference between a first speed of the driving device and a second speed of the controlled device is determined based on the corrected elastic coefficient and the driving force, including: obtaining the corrected rotational inertia of the moving parts in the driving device and the transmission device; and determining the speed difference based on the corrected rotational inertia, the corrected elastic coefficient and the driving force.
[0070] In this solution, for drive devices and transmission devices with multi-stage gears, the moment of inertia of their moving parts is the corrected moment of inertia, that is, the relevant parts of the transmission device are treated as light springs in the calculation process. The corrected moment of inertia can be obtained by measurement under static conditions. The moment of inertia of the moving parts of the transmission device and the moment of inertia of the moving parts of the drive device are corrected and then used in the calculation. The calculation formula for the corrected moment of inertia can be as follows: I = I1 / i1+I2 / i2…+I n / i n
[0071] Among them, i n Can indicate the speed ratio of the corresponding level; I n It can represent the moment of inertia of the moving parts of the transmission device and drive device under the corresponding speed ratio; I can represent the corrected moment of inertia.
[0072] Specifically, after obtaining the corrected moment of inertia, the speed difference can be determined by the following formula: F 驱 -K*∫Δω=I*Δω
[0073] Among them, F 驱 ω represents the driving force, K represents the modified spring coefficient, Δω represents the speed difference, and I represents the modified moment of inertia. Using the highly accurate modified spring coefficient and driving force, the speed difference between the driving device and the controlled device can be determined with high precision, thereby determining the speed and deformation of the controlled device with high precision, enabling high-precision control of the controlled device.
[0074] Optionally, the corrected moment of inertia may be obtained through the relationship between the driving force and the acceleration, or the corrected moment of inertia may be calibrated through curve fitting.
[0075] In one embodiment, determining the deformation of the transmission device based on the speed difference or the rotational speed difference includes: determining a first integral value of the speed difference; determining the first integral value as the deformation; or, determining a second integral value of the rotational speed difference; determining the second integral value as the deformation.
[0076] In this scheme, when the controlled device makes linear motion, the deformation of the transmission device can be determined by the speed difference, and the calculation formula can be as follows: L = ∫ΔV
[0077] Among them, L can represent the deformation, △V can represent the velocity difference, and ∫ can represent the integration operation.
[0078] When the controlled device performs circular motion, the deformation of the transmission device can be determined by the speed difference. The calculation formula can be as follows: L = ∫Δω
[0079] Wherein, L can represent the deformation, △ω can represent the speed difference, and ∫ can represent the integral operation.
[0080] Optionally, the high-precision speed difference and the rotational speed difference can be integrated to obtain a high-precision deformation, thereby achieving high-precision control of the controlled device.
[0081] Optionally, the deformation calculated using the speed difference or the rotational speed difference is the deformation of the transmission device after considering the force transmission delay. A curve diagram of the deformation of the controlled device may be shown in FIG5 . FIG5 is a schematic diagram of the deformation curve of the transmission device provided in an embodiment of the present application. As can be seen from FIG5 , under the action of the driving force shown in FIG3 , compared to the deformation of the transmission device without considering the force transmission delay, the deformation of the transmission device after considering the force transmission delay can more truly reflect the relative motion state of the driving device and the controlled device.
[0082] In one embodiment, determining the second speed based on the first speed and the speed difference includes: determining a first difference between the first speed and the speed difference; and determining the second speed based on a third ratio of the first difference to an overall speed ratio of the transmission.
[0083] In this solution, the first speed can be obtained by sensor measurement or calculation, so the accuracy of the first speed is high. The first speed, the speed difference and the second speed satisfy the following formula: ΔV=V 驱动 -V 输出 *i
[0084] Among them, △V can represent the speed difference, V 驱动 It can represent the first speed of the driving device, V 输出 The second speed of the controlled device can be represented by i, and the total speed ratio of the transmission device can be represented by i. By using the high-precision first speed and the high-precision speed difference, the high-precision second speed can be obtained, eliminating the need for sensors to measure the second speed, thus saving costs and achieving high-precision control of the controlled device.
[0085] Optionally, the second speed of the controlled device may be obtained by sensor measurement or calculation, and the first speed may be calculated using a formula satisfied by the first speed, the speed difference, and the second speed.
[0086] In one embodiment, determining the second speed based on the first speed and the speed difference includes: determining a second difference between the first speed and the speed difference; and determining the second speed based on the second difference and a fourth ratio of the total speed ratio of the transmission device.
[0087] In this solution, the first speed can be obtained by sensor measurement or calculation, so the accuracy of the first speed is high. The first speed, the speed difference and the second speed satisfy the following formula: Δω=ω 驱动 -ω 输出 *i
[0088] Among them, △ω can represent the speed difference, ω 驱动 It can represent the first speed of the driving device, ω 输出 The second speed of the controlled device can be represented by i, and the total speed ratio of the transmission device can be represented by i. By using the high-precision first speed and the high-precision speed difference, the high-precision second speed can be obtained, eliminating the need for a sensor to measure the second speed, thus saving costs and achieving high-precision control of the controlled device.
[0089] Optionally, the second speed of the controlled device may be obtained by sensor measurement or calculation, and the first speed may be calculated using a formula satisfied by the first speed, the speed difference, and the second speed.
[0090] In one embodiment, determining the transmission force of the transmission device according to the modified elastic coefficient and the deformation includes: obtaining a third product of the modified elastic coefficient and the deformation; and determining the transmission force according to the third product.
[0091] In this scheme, the transmission device acts as an ideal elastic medium. When its mass or moment of inertia is ignored, the magnitude of its transmitted force is only related to its deformation, and its transmitted force, input force, and output force are equal.
[0092] Optionally, the transmission force of the transmission device, the input force of the transmission device, the output force of the transmission device, the deformation of the transmission device, and the speed ratio of the transmission device may satisfy the following formula (ideally):
[0093] K*L=F 输入 *i=F 传递 +ΔF,F 传递 =F 输出
[0094] Or K*L=T 输入 *i=T 传递 +ΔT,T 传递 =T 输出
[0095] Wherein, K can represent the modified elastic coefficient; L can represent the deformation of the transmission device; i can represent the total speed ratio of the transmission device; F 输入 It can represent the input longitudinal force of the transmission device; F 传递 Can represent the transmission force of the transmission device; F 输出 Can represent the output force of the transmission device; T 输入 It can represent the input torque of the transmission device; T 传递 It can represent the transmission torque of the transmission device; T 输出 It can represent the output torque of the transmission device; ΔF can represent the delayed force transmitted; ΔT can represent the delayed torque transmitted.
[0096] The output force of the driving device is equal to the input force of the transmission device, the output force of the transmission device is equal to the transmission force of the transmission device, and the force on the controlled device is equal to the transmission force of the transmission device. By determining the transmission force with high precision, the controlled device can be controlled with high precision.
[0097] Optionally, depending on the calculation method, the corresponding relationship between the input force, the speed ratio and the transmission force (ie, the output force) may be different, and the same calculation method may be used in subsequent calculations.
[0098] Optionally, after the transmission force is determined, the difference between the driving force and the transmission force can be determined by the following formula:
[0099] ΔF=F 驱动 *iF 传递 Or ΔT=T 驱动 *iT 传递
[0100] Among them, ΔF can represent the difference between driving force and transmission force, T 驱动 It can represent the driving torque of the driving device, and ΔT can represent the difference between the driving torque of the driving device and the transmission torque of the transmission device. Through ΔF and / or ΔT, high-precision control of the controlled device can also be achieved.
[0101] In one embodiment, the deformation amount, the second speed, the second rotational speed, the transmission force, the speed difference and the rotational speed difference can be output so that the controller or control program can accurately control the movement of the controlled device according to one or more of the deformation amount, the second speed, the second rotational speed, the transmission force, the speed difference and the rotational speed difference.
[0102] The control method of the controlled device provided in the present application obtains the corrected elastic coefficient of the moving parts in the transmission device, the mass or rotational inertia of the driving device and the moving parts in the transmission device, and the driving force of the driving device, and then calculates the deformation of the transmission device, the magnitude of the transmission force of the transmission device, and the magnitude of the force applied to the controlled device, thereby obtaining the speed difference or rotation speed difference between the driving device and the controlled device, and further obtaining the speed, rotation speed and precise position of the controlled device, thereby helping the controller or control program to accurately drive and control the controlled device, while reducing the use of sensors, thereby saving development costs and development cycles.
[0103] The present application also provides a control device for a controlled device. FIG6 is a schematic structural diagram of a control device for a controlled device provided in an embodiment of the present application. As shown in FIG6 , the control device 600 of the controlled device includes:
[0104] Acquisition module 601, used to obtain the modified elastic coefficient of the moving parts in the transmission device and the driving force of the driving device;
[0105] A first determining module 602 is configured to determine a speed difference between a first speed of the driving device and a second speed of the controlled device, and a speed difference between a first rotational speed of the driving device and a second rotational speed of the controlled device based on the modified elastic coefficient and the driving force;
[0106] A second determining module 603 is configured to determine a deformation amount of the transmission device according to the speed difference or the rotation speed difference;
[0107] a third determining module 604 configured to obtain a first speed and a first rotational speed, and determine a second speed based on the first speed and the speed difference, and determine a second rotational speed based on the first rotational speed and the rotational speed difference;
[0108] A fourth determining module 605 is configured to determine a transmission force of the transmission device according to the modified elastic coefficient and the deformation amount;
[0109] The control module 606 is configured to control the movement of the controlled device according to at least one of the deformation, the speed difference, the rotation speed difference, the second speed, the second rotation speed, and the transmission force.
[0110] Optionally, when acquiring the corrected elastic coefficient of the moving parts in the transmission device, the acquisition module 601 is specifically used to: acquire the target speed ratio of the transmission device at a preset level, and the target elastic coefficient of the transmission device at the target speed ratio; and determine the corrected elastic coefficient based on the target speed ratio and the target elastic coefficient.
[0111] Optionally, when the third determination module 604 determines the speed difference between the first speed of the driving device and the second speed of the controlled device based on the corrected elastic coefficient and the driving force, it is specifically used to: obtain the corrected mass of the moving parts in the driving device and the transmission device; and determine the speed difference based on the corrected mass, the corrected elastic coefficient and the driving force.
[0112] Optionally, when the third determination module 604 determines the speed difference between the first speed of the driving device and the second speed of the controlled device based on the corrected elastic coefficient and the driving force, it is specifically used to: obtain the corrected rotational inertia of the moving parts in the driving device and the transmission device; and determine the speed difference based on the corrected rotational inertia, the corrected elastic coefficient and the driving force.
[0113] Optionally, when determining the deformation amount of the transmission device based on the speed difference or the rotational speed difference, the second determination module 603 is specifically used to: determine a first integral value of the speed difference; determine the first integral value as the deformation amount; or, determine a second integral value of the rotational speed difference; determine the second integral value as the deformation amount.
[0114] Optionally, when determining the second speed according to the first speed and the speed difference, the third determination module 604 is specifically configured to: determine a first difference between the first speed and the speed difference; and determine the second speed according to a third ratio of the first difference to the total speed ratio of the transmission device.
[0115] Optionally, when determining the second speed based on the first speed and the speed difference, the third determination module 604 is specifically configured to: determine a second difference between the first speed and the speed difference; and determine the second speed based on the second difference and a fourth ratio of the total speed ratio of the transmission device.
[0116] Optionally, when determining the transmission force of the transmission device according to the modified elastic coefficient and the deformation, the fourth determination module 605 is specifically configured to: obtain a third product of the modified elastic coefficient and the deformation; and determine the transmission force according to the third product.
[0117] The control device of the controlled device provided in this embodiment is used to execute the technical solution of the control method of the controlled device in the aforementioned method embodiment. Its implementation principle and technical effects are similar and will not be repeated here.
[0118] The present application also provides an electronic device. FIG7 is a block diagram of an electronic device according to an exemplary embodiment. As shown in FIG7 , the electronic device 700 includes:
[0119] Processor 711, memory 712, and interactive interface 713;
[0120] Among them, the processor 711 is connected to the memory 712 and the interactive interface 713; the memory 712 is used to store computer-executable instructions executable by the processor 711; the processor 711 is configured to execute the technical solution in the control method of the aforementioned controlled device by executing computer-executable instructions; the interactive interface 713 provides an interface between the processor 711 and the peripheral interface module.
[0121] Optionally, the memory 712 may be independent or integrated with the processor 711 .
[0122] Optionally, when the memory 712 is a device independent of the processor 711 , the electronic device 700 may further include: a bus for connecting the above devices.
[0123] Optionally, the memory may be, but is not limited to, a random access memory (RAM), a read-only memory (ROM), a programmable read-only memory (PROM), an erasable programmable read-only memory (EPROM), an electrically erasable programmable read-only memory (EEPROM), etc. The memory is used to store programs, and the processor executes the programs after receiving an execution instruction. Furthermore, the software programs and modules in the above-mentioned memory may also include an operating system, which may include various software components and / or drivers for managing system tasks (such as memory management, storage device control, power management, etc.), and may communicate with various hardware or software components to provide an operating environment for other software components.
[0124] Alternatively, the processor may be an integrated circuit chip having signal processing capabilities. The aforementioned processor may be a general-purpose processor, including a central processing unit (CPU), a network processor (NP), etc. The disclosed methods, steps, and logic block diagrams in the embodiments of this application may be implemented or executed. The general-purpose processor may be a microprocessor or any conventional processor.
[0125] An embodiment of the present application also provides a computer-readable storage medium, in which computer-executable instructions are stored. When the computer-executable instructions are executed, they are used to implement the technical solution of the control method of the controlled device provided in the aforementioned method embodiment.
[0126] An embodiment of the present application further provides a computer program product, including a computer program, which, when executed, implements the technical solution of the control method of the controlled device provided in the method embodiment.
[0127] Those skilled in the art will appreciate that all or part of the steps in the above-described method embodiments can be implemented using hardware associated with program instructions. The aforementioned program can be stored in a computer-readable storage medium. When executed, the program performs the steps of the above-described method embodiments. The aforementioned storage medium includes various media capable of storing program code, such as ROM, RAM, magnetic disks, or optical disks.
[0128] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present application, rather than to limit them. Although the present application has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or make equivalent replacements for some or all of the technical features therein. These modifications or replacements do not deviate the essence of the corresponding technical solutions from the scope of the technical solutions of the embodiments of the present application.
Claims
1. A control method for a controlled device, characterized in that: include: Obtaining the modified elastic coefficient of the moving parts in the transmission device and the driving force of the driving device; Determining, according to the modified elastic coefficient and the driving force, a speed difference between a first speed of the driving device and a second speed of the controlled device, and a speed difference between a first rotational speed of the driving device and a second rotational speed of the controlled device; determining a deformation amount of the transmission device according to the speed difference or the rotation speed difference; Acquire the first speed and the first rotational speed, and determine the second speed according to the first speed and the speed difference, and determine the second rotational speed according to the first rotational speed and the rotational speed difference; determining a transmission force of the transmission device according to the modified elastic coefficient and the deformation; The movement of the controlled device is controlled according to at least one of the deformation amount, the speed difference, the rotation speed difference, the second speed, the second rotation speed and the transmission force.
2. The control method according to claim 1, characterized in that: Get the corrected spring constants for moving parts in the transmission, including: Obtaining a target speed ratio of the transmission device at a preset number of stages and a target elastic coefficient of the transmission device at the target speed ratio; The modified elastic coefficient is determined according to the target speed ratio and the target elastic coefficient.
3. The control method according to claim 2, characterized in that: Determining a speed difference between a first speed of the driving device and a second speed of the controlled device according to the modified elastic coefficient and the driving force includes: Obtaining the corrected masses of moving parts in the driving device and the transmission device; The speed difference is determined based on the modified mass, the modified spring constant, and the driving force.
4. The control method according to claim 2, characterized in that: Determining a speed difference between a first speed of the driving device and a second speed of the controlled device according to the modified elastic coefficient and the driving force includes: Obtaining the corrected moment of inertia of the moving parts in the driving device and the transmission device; The rotation speed difference is determined based on the modified moment of inertia, the modified spring constant, and the driving force.
5. The control method according to any one of claims 1 to 4, characterized in that: Determining the deformation amount of the transmission device according to the speed difference or the rotation speed difference includes: Determine a first integral value of the speed difference; determine the first integral value as the deformation amount; or, A second integral value of the rotation speed difference is determined; and the second integral value is determined as the deformation amount.
6. The control method according to any one of claims 1 to 4, characterized in that: Determining the second speed according to the first speed and the speed difference includes: determining a first difference between the first speed and the speed difference; The second speed is determined based on a third ratio of the first difference and an overall speed ratio of the transmission.
7. The control method according to any one of claims 1 to 4, characterized in that: Determining the second speed according to the first speed and the speed difference includes: determining a second difference between the first speed and the speed difference; The second rotational speed is determined based on a fourth ratio of the second difference and an overall speed ratio of the transmission.
8. The control method according to any one of claims 1 to 4, characterized in that: Determining the transmission force of the transmission device according to the modified elastic coefficient and the deformation includes: Obtaining a third product of the modified elastic coefficient and the deformation amount; The transmission force is determined based on the third product.
9. A control device for a controlled device, characterized in that: include: An acquisition module, used to obtain the modified elastic coefficient of the moving parts in the transmission device and the driving force of the driving device; a first determining module, configured to determine a speed difference between a first speed of the driving device and a second speed of the controlled device, and a speed difference between a first rotational speed of the driving device and a second rotational speed of the controlled device according to the modified elastic coefficient and the driving force; A second determination module, configured to determine a deformation amount of the transmission device according to the speed difference or the rotation speed difference; a third determination module, configured to obtain the first speed and the first rotational speed, and determine the second speed according to the first speed and the speed difference, and determine the second rotational speed according to the first rotational speed and the rotational speed difference; a fourth determination module, configured to determine a transmission force of the transmission device according to the modified elastic coefficient and the deformation; A control module is used to control the movement of the controlled device according to at least one of the deformation, the speed difference, the rotation speed difference, the second speed, the second rotation speed and the transmission force.
10. An electronic device, characterized in that: include: A processor, and a memory connected to the processor; The memory stores computer-executable instructions; The processor executes the computer-executable instructions stored in the memory to implement the control method of the controlled device according to any one of claims 1 to 8.
11. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores computer-executable instructions, and when the computer-executable instructions are executed, they are used to implement the control method of the controlled device according to any one of claims 1 to 8.
12. A computer program product, comprising a computer program, characterized in that When the computer program is executed, it is used to implement the control method of the controlled device according to any one of claims 1 to 8.
Citation Information
Patent Citations
Servo motor driving control method and device, electronic equipment and storage medium
CN111600526A
Engine control method and device, equipment and readable storage medium
CN113500991A
Integrated transmission device ECU in-loop simulation test platform
CN114706368A
Gear shifting control method and system for AMT gearbox of new energy automobile
CN115306893A
Active return-to-center control method and device, electronic equipment and storage medium
CN115489605A
