WO2022153560A1 - 駆動システム、制御方法および制御プログラム - Google Patents
駆動システム、制御方法および制御プログラム Download PDFInfo
- Publication number
- WO2022153560A1 WO2022153560A1 PCT/JP2021/009172 JP2021009172W WO2022153560A1 WO 2022153560 A1 WO2022153560 A1 WO 2022153560A1 JP 2021009172 W JP2021009172 W JP 2021009172W WO 2022153560 A1 WO2022153560 A1 WO 2022153560A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- actuator
- displacement
- motor
- command
- control
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 36
- 238000006073 displacement reaction Methods 0.000 claims abstract description 103
- 230000007246 mechanism Effects 0.000 description 50
- 230000000116 mitigating effect Effects 0.000 description 43
- 230000006399 behavior Effects 0.000 description 33
- 238000010586 diagram Methods 0.000 description 21
- 230000008569 process Effects 0.000 description 17
- 238000012545 processing Methods 0.000 description 16
- 238000004364 calculation method Methods 0.000 description 11
- 238000012546 transfer Methods 0.000 description 9
- 230000008859 change Effects 0.000 description 8
- 238000013461 design Methods 0.000 description 8
- 238000001514 detection method Methods 0.000 description 7
- 238000004088 simulation Methods 0.000 description 6
- 238000013016 damping Methods 0.000 description 5
- 238000012423 maintenance Methods 0.000 description 5
- 230000007723 transport mechanism Effects 0.000 description 5
- 238000004519 manufacturing process Methods 0.000 description 4
- 238000003860 storage Methods 0.000 description 4
- 230000001133 acceleration Effects 0.000 description 3
- 238000013459 approach Methods 0.000 description 3
- 239000012636 effector Substances 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000003825 pressing Methods 0.000 description 2
- 230000001629 suppression Effects 0.000 description 2
- 230000002123 temporal effect Effects 0.000 description 2
- 230000005483 Hooke's law Effects 0.000 description 1
- 230000008602 contraction Effects 0.000 description 1
- 230000036461 convulsion Effects 0.000 description 1
- 230000002950 deficient Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000003780 insertion Methods 0.000 description 1
- 230000037431 insertion Effects 0.000 description 1
- 238000002955 isolation Methods 0.000 description 1
- 238000010030 laminating Methods 0.000 description 1
- 230000001575 pathological effect Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000002040 relaxant effect Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000004043 responsiveness Effects 0.000 description 1
- 230000035939 shock Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 238000001179 sorption measurement Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F16—ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
- F16F—SPRINGS; SHOCK-ABSORBERS; MEANS FOR DAMPING VIBRATION
- F16F1/00—Springs
- F16F1/02—Springs made of steel or other material having low internal friction; Wound, torsion, leaf, cup, ring or the like springs, the material of the spring not being relevant
- F16F1/04—Wound springs
- F16F1/041—Wound springs with means for modifying the spring characteristics
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02K—DYNAMO-ELECTRIC MACHINES
- H02K7/00—Arrangements for handling mechanical energy structurally associated with dynamo-electric machines, e.g. structural association with mechanical driving motors or auxiliary dynamo-electric machines
- H02K7/06—Means for converting reciprocating motion into rotary motion or vice versa
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P25/00—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details
- H02P25/02—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details characterised by the kind of motor
- H02P25/022—Synchronous motors
- H02P25/024—Synchronous motors controlled by supply frequency
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/04—Arrangements for controlling or regulating the speed or torque of more than one motor
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/08—Arrangements for controlling the speed or torque of a single motor
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/34—Modelling or simulation for control purposes
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39345—Active compliance control, control tension of spring with dc motor
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P2205/00—Indexing scheme relating to controlling arrangements characterised by the control loops
- H02P2205/05—Torque loop, i.e. comparison of the motor torque with a torque reference
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P25/00—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details
- H02P25/02—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details characterised by the kind of motor
- H02P25/06—Linear motors
Definitions
- the present invention relates to a drive system, a control method in the drive system, and a control program for controlling the drive system.
- the performance of a mechanism using a spring or rubber determines the ability to attenuate kinetic energy depending on the physical characteristics of the incorporated spring or rubber. For the damper, the performance of attenuating kinetic energy is determined depending on the size and orifice diameter. The performance of an air cylinder that attenuates kinetic energy is determined depending on the size and air pressure.
- Patent Document 1 describes a vehicle that moves over a rough surface so as to facilitate a significant reduction in the force transmitted to the vehicle body supported on the wheel support assembly.
- pathological, typically linear, controllable sources of energy for actively absorbing energy from a wheel support assembly or applying energy to the assembly.
- Patent Document 2 discloses a method for actively suspending actual equipment in a vehicle. The disclosed method comprises modifying the control signal based on the difference between the characteristics of the actual equipment as indicated by the response of the actual equipment to this control signal and the characteristics of the reference equipment.
- Patent Document 3 discloses an active vibration suppression device configured to control the position of the body with respect to a reference frame.
- the electrical actuator as described above can have a complicated configuration such as control logic. For example, it is necessary to configure the control logic in consideration of the characteristics of an object that mechanically contacts the actuator, and if there are many parameters included in the control logic, tuning takes time and effort.
- One object of the present invention is to provide a drive system including an actuator capable of easily performing a control logic configuration, a simulation for equipment design, and the like.
- a drive system includes an actuator driven by a motor to cause displacement, a driver for driving the motor, and a controller for giving a control command to the driver.
- the controller generates a model component that constitutes a physical model and a control command to the motor so that the actuator causes a displacement according to the physical model based on the displacement caused by applying an external load to the actuator.
- a command generator for generating a control command to the motor so as to generate a driving force calculated based on the product of the command generator of 1 and the determination unit for determining the spring constant and the displacement generated in the actuator. It includes a command generation unit 2 and a selection unit for selecting from which of the first command generation unit and the second command generation unit the control command is to be activated.
- the behavior of generating a load according to the behavior of a spring can be selectively executed.
- the selection unit may activate the control command from the second command generation unit when a predetermined switching condition is satisfied while the control command from the first command generation unit is enabled. .. According to this configuration, it is possible to realize an operation of generating a predetermined load from the actuator after performing an operation of relaxing the load applied to the actuator in accordance with a control command from the first command generation unit.
- the switching condition may be based on the elapsed time from when an external load is applied to the actuator. According to this configuration, for example, it is possible to realize a control that switches the behavior when a predetermined time elapses from the start of the operation of the actuator.
- the switching condition may be based on the displacement occurring in the actuator. According to this configuration, for example, control that switches the behavior when the actuator contracts by a predetermined amount can be realized.
- the first command generator outputs a position command for designating the target position of the motor as a control command
- the second command generator outputs a torque command for specifying the torque to be generated by the motor as a control command. It may be.
- the first command generator controls the position of the actuator, so that the ideal spring behavior can be realized.
- the second command generator controls the torque to be generated by the motor, so that the load generated by the actuator can be controlled according to the ideal behavior of the spring.
- the model component may configure a physical model when a predetermined load is applied to the actuator from the outside. According to this configuration, it is possible to start the behavior as a spring when a predetermined load is applied from the outside while maintaining a stationary state until a predetermined load is applied from the outside.
- the determination unit may set the spring constant for each control cycle. According to this configuration, the optimum spring constant in each control cycle can be set according to the purpose and the situation.
- a method of controlling an actuator driven by a motor to cause displacement is to construct a physical model based on the displacement caused by applying an external load to the actuator, to determine the spring constant, and to make the motor cause a displacement according to the physical model. Calculated based on the product of the spring constant and the displacement occurring in the actuator when certain switching conditions are met while controlling the motor so that the step to be controlled and the displacement occur according to the physical model. It includes a step of switching the control of the motor so as to generate the driving force to be generated.
- a control program for controlling an actuator driven by a motor to cause displacement tells the computer to construct a physical model based on the displacement caused by the external load applied to the actuator, to determine the spring constant, and to cause the displacement according to the physical model. Based on the product of the spring constant and the displacement occurring in the actuator when certain switching conditions are met while controlling the motor so that the steps that control the motor cause the displacement according to the physical model.
- the step of switching the control of the motor is executed so as to generate the driving force calculated by the above.
- FIG. 1 It is a figure for demonstrating the elastic force generation operation of the actuator which concerns on this embodiment. It is a schematic diagram which shows the main functional structure for realizing the elastic force generation operation by the actuator which concerns on this embodiment. It is a figure for demonstrating the process for suppressing the generation of the impact force by the contact between the objects using the actuator which concerns on this embodiment. It is a schematic diagram which shows the main functional composition for realizing the impact mitigation operation and the elastic force generation operation by the actuator which concerns on this embodiment. It is a flowchart which shows an example of the processing procedure which concerns on the impact mitigation operation and the elastic force generation operation by the actuator which concerns on this embodiment. It is a schematic diagram which shows the example of the stage mechanism of 1 degree of freedom which includes a plurality of actuators which concerns on this embodiment. FIG.
- FIG. 3 is a schematic diagram showing a main functional configuration for realizing an elastic force generation operation by the stage mechanism shown in FIG. 13 (A). It is a schematic diagram which shows the example of the stage mechanism of multi-degree-of-freedom including a plurality of actuators which concerns on this embodiment. It is a schematic diagram which shows an example of the application using the actuator which concerns on this embodiment. It is a flowchart which shows the processing procedure in the assembly apparatus shown in FIG.
- FIG. 1 is a schematic view showing a main part of the drive system 1 according to the present embodiment.
- the drive system 1 includes an actuator 2 and a drive device 4.
- the actuator 2 is driven by the motor 18 to cause a displacement (in the example shown in FIG. 1, the displacement in the vertical direction of the paper surface).
- a displacement in the example shown in FIG. 1, the displacement in the vertical direction of the paper surface.
- any configuration driven by a motor may be adopted, and for example, a ball screw, a linear actuator, or the like can be used.
- a ball screw a linear actuator, or the like can be used.
- the actuator 2 is mainly composed of a ball screw will be described.
- the actuator 2 includes a main body portion 10 having a space inside, a rod 12 that engages with a screw groove formed inside the main body portion 10, and a tip portion provided at the tip of the rod 12.
- 14 includes a connecting member 16 that mechanically connects the rod 12 and the motor 18, and an encoder 20 that detects the rotation speed or the angle of rotation of the motor 18.
- the encoder 20 is mechanically connected to the motor 18 to detect the displacement of the actuator 2.
- the drive device 4 includes a driver 42 that supplies electric power to the motor 18 to drive the motor 18, and a controller 40 that receives a detection signal from the encoder 20 and gives a control command to the driver 42.
- FIG. 1 shows an example of a drive system 1 composed of one actuator 2, a configuration including a plurality of actuators 2 can also be realized.
- FIG. 2 is a schematic view showing a main part of a modified example of the drive system 1 according to the present embodiment.
- the drive system 1 has three actuators 2.
- the drive device 4 includes three drivers 42 corresponding to the respective actuators 2 and a controller 40 that collectively controls the three actuators 2.
- the number of actuators 2 included in the drive system 1 is not particularly limited, and an appropriate number may be set according to the application to be applied. For example, if an arbitrary work can be supported by a single actuator 2, only one actuator 2 may be used. Further, for a large work, a member for supporting the work may be configured to be driven by a plurality of actuators 2.
- controller 40 and the driver 42 are drawn as independent components, but the controller 40 and the driver 42 may be mounted as independent devices, or both may be mounted as an integrated device. May be good.
- FIG. 3 is a diagram for explaining the behavior of the actuator 2 constituting the drive system 1 according to the present embodiment.
- the actuator 2 is controlled so that the spring behaves ideally.
- the ideal behavior of the spring is, for example, assuming a spring having a natural length X 0 in a state where no external force is applied, as shown in FIG. 3 (A).
- a physical spring is realized by controlling the motor 18. Since the realized spring exhibits substantially ideal behavior (behavior according to a physical formula), it is possible to easily perform a control logic configuration using a simple physical model and a simulation for equipment design.
- FIG. 4 is a schematic diagram showing a hardware configuration example of the controller 40 constituting the drive system 1 according to the present embodiment.
- the controller 40 is a kind of computer and includes a processor 402, a main memory 404, an input / output unit 406, and a storage 408 as main hardware components.
- the processor 402 is typically composed of a CPU (Central Processing Unit), an MPU (Micro-Processing Unit), etc., reads the system program 410 and the control program 412 stored in the storage 408, and expands them to the main memory 404. By executing the above, a control calculation for controlling the behavior of the actuator 2 as described later is realized.
- a CPU Central Processing Unit
- MPU Micro-Processing Unit
- the input / output unit 406 is in charge of transmitting and receiving signals between the controller 40 and the external device.
- the input / output unit 406 receives the detection signal from the encoder 20 and transmits a control command to the driver 42.
- the storage 408 is typically composed of an SSD (Solid State Disk), a fresh memory, or the like, and stores a system program 410 and a control program 412 for realizing basic processing.
- SSD Solid State Disk
- FIG. 4 shows a configuration example in which the necessary processing is provided by the processor 402 executing the program, and a part or all of the provided processing is provided by a dedicated hardware circuit (for example, ASIC). It may be implemented using (Application Specific Integrated Circuit) or FPGA (Field-Programmable Gate Array).
- ASIC Application Specific Integrated Circuit
- FPGA Field-Programmable Gate Array
- FIG. 5 is a schematic view of a work transfer system 100 in which the actuator 2 according to the present embodiment performs an impact mitigation operation.
- the stage mechanism 110 includes a base portion 112 and a plate 114.
- the base portion 112 and the plate 114 are mechanically connected via the actuator 2 according to the present embodiment.
- the actuator 2 is drawn as a spring for easy understanding.
- the actuator 2 As shown in FIG. 5, the actuator 2 according to the present embodiment is used in order to alleviate an excessive load (impact force) generated when an object comes into contact with an object or to suppress the occurrence of a point load. , Performs impact mitigation operation.
- an excessive load impact force
- the spring behaves when it receives an external force, that is, it contracts or expands to a position corresponding to a displacement in which a restoring force corresponding to the external force is generated (that is, a balanced position).
- Such contraction or extension behavior follows a physical model, which is a substantially ideal physical behavior.
- FIG. 6 is a diagram for explaining the behavior from the physical viewpoint related to the impact mitigation operation of the actuator 2 according to the present embodiment.
- the mass M1 of the plate 114 is given to the actuator 2 by attaching the plate 114 to the state where no load is applied to the actuator 2 acting as a spring (natural length state 50).
- the actuator 2 receives a load of the mass M1 of the plate 114 and is in an equilibrium state at a position (balanced position) shortened by a predetermined length ⁇ Xb (balanced state 52). At this time, it is assumed that the length of the actuator 2 is Xb.
- the behavior as a spring is calculated based on the equilibrium position. For example, when a load F is applied to the actuator 2, an equilibrium state is reached at a position (a position when the load F is generated) shortened by a predetermined length Xb from the equilibrium position (load equilibrium state 54). At this time, it is assumed that the length of the actuator 2 is X.
- the behavior as a spring is determined according to the collapse from the balanced state 52.
- a simple vibration model is assumed as the simplest physical model.
- the period T 2 ⁇ (M1 / K) of the simple vibration of the spring. ..
- a physical model or the like is determined based on the displacement ⁇ X based on the state in which the object is attached to the actuator 2 (balanced state 52).
- the behavior of the spring is reproduced by the actuator 2 by using a physical model showing the behavior of the spring.
- FIG. 7 is a schematic diagram showing a main functional configuration for realizing the impact mitigation operation by the actuator 2 according to the present embodiment.
- the controller 40 includes a physical model 420, a characteristic estimation unit 422, an angular frequency setting unit 424, and a position command generation unit 426.
- the physical model 420 is a model for realizing the behavior as a spring.
- FIG. 7 shows a simple vibration model as an example.
- the characteristic estimation unit 422 corresponds to a model component that constitutes the physical model 420 based on the displacement generated by applying an external load to the actuator 2. More specifically, the characteristic estimation unit 422 estimates the parameter (amplitude A1 in the example shown in FIG. 7) included in the physical model 420 based on the detection signal from the encoder 20. The estimated parameters are reflected in the physical model 420. In the physical model 420, the characteristics (parameters) are determined based on the changes caused by applying an arbitrary load F to the actuator 2.
- the amplitude A1 of the physical model 420 can be calculated based on the position change (velocity) immediately after an arbitrary load F is applied to the actuator 2.
- the characteristic estimation unit 422 estimates the parameters of the physical model 420 based on the temporal changes (velocity, acceleration, jerk, etc.) of the displacement of the actuator 2.
- the estimated parameters are appropriately determined according to the physical model 420.
- the spring constant and the damping constant may be determined.
- the physical model 420 has the characteristics of the actuator 2 according to a predetermined load from the outside.
- the position command generation unit 426 generates a control command so that the actuator 2 causes a displacement according to the physical model 420. More specifically, the position command generation unit 426 generates a control command (position command or displacement command) in each control cycle based on the displacement ⁇ X calculated according to the physical model 420, and outputs the control command (position command or displacement command) to the driver 42. That is, the position command generation unit 426 may output a position command for designating the target position of the motor 18 as a control command.
- the parameters that define the physical model 420 are estimated by the above processing procedure. Then, the behavior of the actuator 2 is determined according to the physical model 420 including the estimated parameters.
- a physical spring (operates as a damper) is realized by controlling the motor 18. Since the control is performed based on the equilibrium position, even when the applied load is small, the behavior according to the physical formula can be realized. Since the behavior follows the physical formula, pre-calculation and simulation when designing the control system are facilitated, and even when the actual device is configured, the deviation from the pre-design is reduced.
- FIG. 8 is a diagram for explaining the elastic force generation operation of the actuator 2 according to the present embodiment.
- the actuator 2 is displaced according to the physical model.
- the temporal change of the displacement as shown in FIG. 8B is shown.
- the magnitude of the load Fa changes as shown in FIG. 8 (D) by changing the spring constant K with time.
- the fluctuation of the generated load Fa is suppressed by increasing the spring constant K with the passage of time.
- the spring constant K corresponding to the displacement ⁇ X may be calculated in each control cycle.
- FIG. 9 is a schematic diagram showing a main functional configuration for realizing the elastic force generation operation by the actuator 2 according to the present embodiment.
- the controller 40 includes a load command generation unit 428, a spring constant changing unit 430, and a displacement calculation unit 432.
- the spring constant changing unit 430 corresponds to a determining unit that determines the spring constant K.
- the spring constant changing unit 430 may set the spring constant K for each arbitrary section, or may set the spring constant K for each control cycle. As an example, the spring constant changing unit 430 sets the spring constant K (t) in each control cycle according to a predetermined pattern.
- the spring constant changing unit 430 may have a pattern for outputting the spring constant K (t) as shown in FIG. 8 (C).
- a plurality of patterns of the spring constant may be stored in the spring constant changing unit 430. In that case, one of a plurality of patterns may be selected according to the setting mode.
- the displacement calculation unit 432 calculates the displacement ⁇ X generated in the actuator 2 based on the detection signal from the encoder 20.
- the displacement ⁇ X calculated by the displacement calculation unit 432 is calculated based on a state in which an object (plate 114 in the example shown in FIGS. 1 and 2) is attached to the actuator 2.
- the load command generation unit 428 generates a control command so as to generate a driving force calculated based on the product of the spring constant K and the displacement ⁇ X generated in the actuator 2. More specifically, the load command generation unit 428 should be generated in each control cycle based on the displacement ⁇ X calculated by the displacement calculation unit 432 and the spring constant K (t) from the spring constant change unit 430.
- the load Fa corresponding to the displacement ⁇ X and the spring constant K can be generated from the actuator 2.
- the damping constant may be changed with time in addition to the spring constant K or instead of the spring constant K.
- a physical spring (operates as a damper) is realized by controlling the motor 18. Since the behavior follows the physical formula, pre-calculation and simulation when designing the control system are facilitated, and even when the actual device is configured, the deviation from the pre-design is reduced.
- the elastic force generating operation since the load is generated in proportion to the displacement generated in the actuator, a sensor or the like for measuring the external force (load from the outside) becomes unnecessary. Therefore, even a manufacturing device having high rigidity or a manufacturing device having a non-negligible internal resistance can precisely control the generated load.
- the purpose is according to the application while following the physical formula that the load is generated in proportion to the displacement generated in the actuator. Can generate a load of.
- FIG. 10 is a diagram for explaining a process for suppressing the generation of an impact force due to contact between objects using the actuator 2 according to the present embodiment.
- the actuator 2 when the impact mitigation operation is executed in advance and some load is applied, the actuator 2 operates passively according to the applied load. After that, the operation is switched to the elastic force generation operation under a predetermined switching condition, and a load calculated based on the spring constant defined by the generated displacement and pattern is generated.
- the actuator 2 does not undergo any displacement unless an external force (load from the outside) is applied.
- an external force load from the outside
- parameters corresponding to the applied external force are calculated, and the displacement of the actuator 2 is controlled by a physical model having the calculated parameters.
- the switching conditions for switching between the impact mitigation operation and the elastic force generation operation include the elapsed time from the external load applied to the actuator 2, the displacement (current position) occurring in the actuator 2, and the trigger from the external device. And so on.
- FIG. 11 is a schematic diagram showing a main functional configuration for realizing the impact mitigation operation and the elastic force generation operation by the actuator 2 according to the present embodiment.
- the controller 40 includes a physical model 420, a characteristic estimation unit 422, an angular frequency setting unit 424, a position command generation unit 426, a load command generation unit 428, and a spring constant changing unit 430.
- the displacement calculation unit 432 and the selection unit 434 are included.
- the functional configuration shown in FIG. 11 is a combination of the functional configuration for realizing the impact mitigation operation shown in FIG. 7 and the functional configuration for realizing the elastic force generating operation shown in FIG. 9, and then the selection unit 434 is selected.
- the selection unit 434 is a control command for realizing the impact mitigation operation output from the position command generation unit 426 and a control command for realizing the elastic force generation operation output from the load command generation unit 428. Select from which control command to enable.
- the selection unit 434 has a switching condition 436, and a control command output from the position command generation unit 426 and a control output from the load command generation unit 428 based on whether or not the switching condition 436 is satisfied. Select one of the commands and output. Typically, the selection unit 434 activates the control command from the load command generation unit 428 when the switching condition 436 is satisfied while the control command from the position command generation unit 426 is enabled.
- FIG. 12 is a flowchart showing an example of a processing procedure related to the impact mitigation operation and the elastic force generation operation by the actuator 2 according to the present embodiment.
- Each step shown in FIG. 12 is typically realized by the processor 402 of the controller 40 executing the control program 412.
- the processor 402 executes the control program 412
- a library or the like provided by the system program 410 may be used for a part of the processing.
- steps S2 to S14 correspond to processes related to the impact mitigation operation
- steps S20 to S28 correspond to processes related to the elastic force generation operation.
- the controller 40 first executes the process related to the impact mitigation operation. More specifically, the controller 40 determines whether or not a load exceeding a predetermined value is applied to the actuator 2 based on the detection signal by the encoder 20 (step S2). If a load exceeding a predetermined value is not applied to the actuator 2 (NO in step S2), the process of step S2 or less is repeated.
- step S2 When a load exceeding a predetermined value is applied to the actuator 2 (YES in step S2), the controller 40 calculates the speed of the actuator 2 based on the detection signal by the encoder 20 (step S4), and based on the calculated speed. , Estimate the parameters of the physical model (step S6). Then, the controller 40 configures a physical model including the estimated parameters (step S8). In this way, the controller 40 constitutes a physical model based on the displacement caused by applying an external load to the actuator 2.
- the controller 40 inputs the elapsed time from the application of a load exceeding a predetermined value to the actuator 2 into the physical model, calculates a control command (position command or displacement command) in the current control cycle (step S10), and then calculates the control command (position command or displacement command).
- the calculated control command is output to the driver 42 (step S12). That is, the controller 40 controls the motor 18 so that the actuator 2 is displaced according to the physical model.
- step S14 the controller 40 determines whether or not the condition for switching to the elastic force generation operation (switching condition 436) is satisfied (step S14). If the condition for switching to the elastic force generation operation is not satisfied (NO in step S14), the process of step S10 or less is repeated.
- the controller 40 executes the following processing related to the elastic force generation operation. More specifically, the controller 40 determines the spring constant K in the current control cycle with reference to a preset pattern (step S20). In this way, the controller 40 determines the spring constant K.
- the controller 40 acquires the current displacement of the actuator 2 (step S22), and calculates the load to be generated by the actuator 2 based on the spring constant K and the current displacement of the actuator 2 (step S24). .. Then, the controller 40 calculates a control command (position command or displacement command) corresponding to the load to be generated (step S26), and outputs the calculated control command to the driver 42 (step S28). In this way, the controller 40 controls the motor 18 so as to generate a driving force calculated based on the product of the spring constant K and the displacement ⁇ X generated in the actuator 2.
- the controller 40 causes the spring constant K and the actuator 2 to be satisfied.
- the control of the motor 18 is switched so as to generate a driving force calculated based on the product of the displacement ⁇ X generated in.
- step S30 the controller 40 determines whether or not the end condition of the elastic force generation operation is satisfied. If the end condition of the elastic force generation operation is not satisfied (NO in step S30), the process of step S20 or less is repeated.
- step S30 If the end condition of the elastic force generation operation is satisfied (YES in step S30), the process ends.
- FIG. 12 shows an example of processing in which the impact mitigation operation and the elastic force generation operation by the actuator 2 according to the present embodiment are combined, but only the impact mitigation operation and the elastic force generation operation are performed. You may. An appropriate operation will be selected according to the application that uses the actuator 2.
- Example of drive mechanism> For convenience of explanation, the configuration including a single actuator 2 has been illustrated, but a mechanism including a plurality of actuators 2 may be realized. Hereinafter, an example of the drive mechanism including the actuator 2 will be described.
- FIG. 13 is a schematic view showing an example of a stage mechanism having one degree of freedom including a plurality of actuators 2 according to the present embodiment.
- 13 (A) and 13 (B) show a configuration example of a stage mechanism in which the plate 114 is supported by three actuators 2-1, 2, 2-3.
- a plurality of actuators 2 are mechanically connected to a plate 114 which is a common member.
- the controller 40 can control the entire surface of the plate 114 by synchronously controlling the actuators 2-1, 2, 2 and 2-3. At this time, the controller 40 generates control commands for the actuators 2-1, 2, 2 and 2-3 so that the target load is generated from the plate 114, which is a common member.
- the controllers 40-1, 40-2, and 40-3 control the actuators 2-1 and 2, 2-3, respectively.
- the actuators 2-1, 2, 2 and 2-3 independently, even when a local load is applied to the plate 114, the behavior according to the local load can be performed. can.
- FIG. 14 is a schematic diagram showing a main functional configuration for realizing the elastic force generation operation by the stage mechanism shown in FIG. 13 (A).
- actuators 2-1, 2, 2-3 are driven by drivers 42-1, 42-2, 42-3, respectively, and encoders 20-1, 20-2, 20-3. Displacement is detected by.
- the controller 40 has load command generation units 428-1, 428-2, 428-3 and spring constant change units 430-1, 430-2 in order to control actuators 2-1, 2, 2 and 2-3. , 430-3 and the displacement calculation unit 432-1,432-2,432-3, respectively.
- each spring constant is controlled between the spring constant changing units 430-1, 430-2, and 430-3.
- the spring constants may be changed gradually in synchronization with each other, or the spring constants may be arbitrated so as to correct the variation in displacement.
- the load generated by the plate 114 can be controlled over the entire surface.
- the load generated on the plate 114 can be controlled over the entire surface by synchronizing the physical models corresponding to the respective actuators with each other.
- FIG. 15 is a schematic view showing an example of a multi-degree-of-freedom stage mechanism 110A including a plurality of actuators 2 according to the present embodiment.
- the stage mechanism 110A is a Z ⁇ stage having two degrees of freedom. More specifically, the stage mechanism 110A includes a rotating member 118 configured to rotate in the ⁇ -axis direction and three actuators 2-1, 2, 2 and 2-3 extending in the Z-axis direction. ..
- stage mechanism 110A By using the stage mechanism 110A as shown in FIG. 15, it can be used in various applications.
- the actuator 2 according to the present embodiment can be used as a single actuator 2 or as a stage in which the actuator 2 is incorporated. Furthermore, it can also be used as a manufacturing apparatus including a stage.
- FIG. 16 is a schematic diagram showing an example of an application using the actuator 2 according to the present embodiment.
- FIG. 16 shows an application in which both works are overlapped in order to attach the work W1 and the work W2.
- the assembly device 200 on which the two workpieces are superposed includes the stage mechanism 110A, the transfer mechanism 150, and the controller 40.
- the work W1 is arranged on the plate 114 of the stage mechanism 110A.
- the work W2 superimposed on the work W1 is conveyed by the transfer mechanism 150 from above the stage mechanism 110A.
- the controller 40 gives a control command to the stage mechanism 110A to control the stage mechanism 110A.
- the stage mechanism 110A includes one or a plurality of actuators 2 driven by a motor 18 to cause displacement in a first direction (Z-axis direction). Since the configuration of the stage mechanism 110A has been described with reference to FIG. 15, detailed description will not be repeated.
- the transport mechanism 150 includes a support column 152 and a plate 154.
- the plate 154 is connected to the support column 152, and can be moved in the vertical direction of gravity by a drive mechanism (not shown).
- Adsorption holes are formed on the surface of the plate 154.
- the work W2 is conveyed in a state of being adsorbed on the surface of the plate 154 by a suction mechanism (not shown).
- the processing procedure in the assembly apparatus 200 will be described with reference to FIG. 16 (B).
- the displacements of the actuators 2-1, 2, 2 and 2-3 of the stage mechanism 110A are adjusted so that the work W1 and the work W2 are parallel ((1) parallel maintenance operation). That is, the controller 40 gives a control command to the stage mechanism 110A so that the work W1 and the work W2 are parallel to each other according to the work W2 superposed on the work W1.
- the parallel maintenance operation may be realized by feedback control based on a detection signal by a sensor (not shown) provided in the transport mechanism 150.
- a predetermined distance margin is provided between the works so that the work W1 and the work W2 do not collide with each other by adjusting the orientation.
- the impact mitigation operation is started ((3) impact mitigation operation). That is, the controller 40 constitutes a physical model based on the displacement caused by the work W2 coming into contact with the work W1 on the actuator 2. Then, the controller 40 generates a control command that causes the actuator 2 to be displaced according to the physical model. In this way, when the work W2 comes into contact with the work W1 and a load is applied to the actuator 2, the actuator 2 operates like a spring according to the physical model as described above.
- the impact mitigation operation can avoid an excessive load or point load caused by contact between the work W1 and the work W2.
- the elastic force generation operation is started ((4) elastic force generation operation). That is, a control command is generated that generates a driving force calculated based on the product of the spring constant K and the displacement ⁇ X generated in the actuator 2. Due to the elastic force generation operation, a pressing force is generated between the work W1 and the work W2, and the attachment between the work W1 and the work W2 is completed.
- FIG. 17 is a flowchart showing a processing procedure in the assembly apparatus 200 shown in FIG. Each step shown in FIG. 17 is typically realized by the processor 402 of the controller 40 executing the control program 412. When the processor 402 executes the control program 412, a library or the like provided by the system program 410 may be used for a part of the processing.
- step S100 the controller 40 gives an instruction to arrange the work W1 on the stage mechanism 110A and an instruction to suck the work W2 to the transfer mechanism 150. Output (step S102). Then, the controller 40 outputs an instruction to bring the work W2 attracted to the transport mechanism 150 closer to the work W1 (step S104), and starts the parallel maintenance operation.
- the controller 40 uses the actuators 2-1 and 2-2 of the stage mechanism 110A so that the work W1 and the work W2 are parallel to each other based on the inclination of the work W2 attracted to the transport mechanism 150. , 2-3 displacements are adjusted (step S106). In this way, the controller 40 gives a control command to the stage mechanism 110A so that the work W1 and the work W2 are parallel to each other according to the work W2 superposed on the work W1.
- the controller 40 determines whether or not the switching condition for switching to the inter-work approach operation is satisfied based on the degree of parallelism between the work W1 and the work W2 (step S108). If the switching condition is not satisfied (NO in step S108), the process of step S106 or less is repeated.
- step S108 the controller 40 determines the actuators 2-1, 2, 2-3 of the stage mechanism 110A so that the work W1 and the work W2 are maintained in parallel. The displacement of is adjusted (step S110). Then, the controller 40 determines whether or not the switching condition for switching to the impact mitigation operation is satisfied based on the distance between the work W1 and the work W2 (step S112). If the switching condition is not satisfied (NO in step S112), the process of step S110 or less is repeated.
- step S110 the controller 40 starts the impact mitigation operation (step S114).
- the processes according to steps S2 to S14 of FIG. 12 are executed.
- the controller 40 starts the elastic force generation operation (step S116).
- the processes according to steps S20 to S28 of FIG. 12 are executed.
- the controller 40 When the superposition of the work W1 and the work W2 is completed, the controller 40 outputs an instruction for transporting the superposed work W1 and the work W2 to the next process (step S118). With the above, one process is completed.
- the impact generated between the works is alleviated, and the damage generated between the works is reduced, and the surface between the works is reduced.
- the pressure can be made uniform and pressed. This makes it possible to reduce the occurrence of defective products and manufacture higher quality workpieces.
- control of the actuator 2 impact mitigation operation and / or elastic force generation operation
- the control of the actuator 2 is an arbitrary application including contact between objects such as transfer, superposition, laminating, and insertion. Applicable to.
- the impact mitigation operation of the actuator 2 according to the present embodiment can be applied to a spring mechanism such as vibration isolation and vibration suppression, a tensioner, etc. by itself.
- the elastic force generating operation of the actuator 2 according to the present embodiment can be applied to a mechanism for generating an arbitrary load such as a pressing device by itself.
- Impedance control and admittance control are examples of techniques for controlling load and position.
- Impedance control is a technique that adjusts the characteristics (softness) of the actuator so that it stays at the target position when a load is applied to the actuator with the target position and impedance set in advance. Therefore, it does not realize the control for alleviating the impact force such as the impact mitigation operation according to the present embodiment, but rather a larger impact force may be generated. Further, in the impedance control, since the target position is given, it is not possible to control the generated load as in the elastic force generating operation according to the present embodiment.
- admittance control when a load is applied to the actuator with the impedance set in advance, the operating speed (position in each control cycle) is controlled based on the impedance. Therefore, since only the behavior based on the preset impedance can be performed, the behavior cannot be changed according to the impact force such as the impact mitigation operation according to the present embodiment. Further, since the admittance control determines the behavior when the load is applied to the actuator, it is not possible to control the generated load as in the elastic force generating operation according to the present embodiment.
- the impact mitigation operation and the elastic force generation operation according to the present embodiment are completely different from the impedance control and the admittance control.
- FIG. 1 An actuator (2) driven by a motor (18) to cause displacement, The driver (42) that drives the motor and A controller (40) that gives a control command to the driver is provided.
- the controller A model component (422) that constitutes a physical model based on the displacement generated by applying an external load to the actuator, and A first command generator (426) that generates a control command to the motor so that the actuator causes a displacement according to the physical model.
- a determination unit (430) that determines the spring constant, and A second command generator (428) that generates a control command to the motor so as to generate a driving force calculated based on the product of the spring constant and the displacement generated in the actuator.
- a drive system including a selection unit (436) for selecting from which of the first command generation unit and the second command generation unit the control command is to be activated.
- the selection unit activates the control command from the second command generation unit when a predetermined switching condition is satisfied while the control command from the first command generation unit is enabled.
- the drive system according to 1.
- the first command generation unit outputs a position command for designating a target position of the motor as the control command, and outputs the position command.
- the drive system according to any one of configurations 1 to 4, wherein the second command generation unit outputs a torque command for designating a torque to be generated by the motor as the control command.
- [Structure 8] It is a control method of an actuator (2) that is driven by a motor (18) and causes displacement. Steps (S4, S6, S8) for constructing a physical model based on the displacement caused by applying an external load to the actuator, and Step (S20) to determine the spring constant, A step (S10, S12) of controlling the motor so that the actuator causes a displacement according to the physical model. When a predetermined switching condition is satisfied while controlling the motor so that the actuator causes a displacement according to the physical model, it is calculated based on the product of the spring constant and the displacement generated in the actuator. A control method comprising a step (S22, S24, S26, S28) of switching the control of the motor so as to generate the driving force to be generated.
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Evolutionary Computation (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Health & Medical Sciences (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Robotics (AREA)
- Control Of Position Or Direction (AREA)
- Connection Of Motors, Electrical Generators, Mechanical Devices, And The Like (AREA)
- Reciprocating, Oscillating Or Vibrating Motors (AREA)
- Linear Motors (AREA)
- Feedback Control In General (AREA)
- Control Of Electric Motors In General (AREA)
- Vibration Prevention Devices (AREA)
Abstract
Description
まず、本発明が適用される場面の一例について説明する。
<B.コントローラ40のハードウェア構成例>
次に、本実施の形態に係る駆動システム1を構成するコントローラ40のハードウェア構成例について説明する。
次に、本実施の形態に係るアクチュエータ2の衝撃緩和動作について説明する。衝撃緩和動作においては、アクチュエータ2は与えられる荷重に応じてパッシブに動作する。
速度V=A1×ω×cos(ωt)
加速度a=A1×ω2×sin(ωt)=-ω2ΔX
後述するように、アクチュエータ2に物体が取り付けられた状態(つり合い状態52)を基準とした変位ΔXに基づいて、物理モデルなどが決定される。
次に、本実施の形態に係るアクチュエータ2の弾性力発生動作について説明する。弾性力発生動作においては、フックの法則(Fa=バネ定数K×変位ΔX)に従って算出される荷重を発生する。本実施の形態においては、バネ定数Kを可変することで、目的の荷重(弾性力)をワークWなどに対して与えることができる。
上述した衝撃緩和動作および弾性力発生動作を切り替えることで、ワークWが接触する場合などに大きな荷重(衝撃力)が発生することを防止することができる。
説明の便宜上、単一のアクチュエータ2からなる構成について例示したが、複数のアクチュエータ2を含む機構を実現してもよい。以下、アクチュエータ2を含む駆動機構の一例について説明する。
図13は、本実施の形態に係るアクチュエータ2を複数含む1自由度のステージ機構の例を示す模式図である。図13(A)および図13(B)には、プレート114が3つのアクチュエータ2-1,2-2,2-3で支持されたステージ機構の構成例を示す。図13(A)および図13(B)に示されるステージ機構においては、共通の部材であるプレート114に複数のアクチュエータ2が機械的に接続されている。
図15は、本実施の形態に係るアクチュエータ2を複数含む多自由度のステージ機構110Aの例を示す模式図である。
上述したように、本実施の形態に係るアクチュエータ2は、アクチュエータ2単体で利用することもできるし、アクチュエータ2を組み込んだステージとして利用することもできる。さらに、ステージを含む製造装置として利用することもできる。
本実施の形態に係るアクチュエータ2を用いたアプリケーションの一例について説明する。
まず、ワークW1とワークW2とが平行になるように、ステージ機構110Aのアクチュエータ2-1,2-2,2-3の変位が調整される((1)平行維持動作)。すなわち、コントローラ40は、ワークW1と重ね合わせられるワークW2に応じて、ワークW1とワークW2とが平行になるようにステージ機構110Aに制御指令を与える。
上述したように、本実施の形態に係るアクチュエータ2の制御(衝撃緩和動作および/または弾性力発生動作)は、搬送、重ね合わせ、張り合わせ、挿入といった、物体と物体との接触を含む任意のアプリケーションに適用可能である。
本実施の形態によれば、アクチュエータが物理式に従う挙動をとるので、制御ロジックの構成や設備設計のためのシミュレーションを容易に行うことができる。また、実際の装置を構成した場合にも、事前の設計からのズレが少なくなる。
上述したような本実施の形態は、以下のような技術思想を含む。
モータ(18)により駆動されて変位を生じるアクチュエータ(2)と、
前記モータを駆動するドライバ(42)と、
前記ドライバに制御指令を与えるコントローラ(40)とを備え、
前記コントローラは、
前記アクチュエータに外部からの荷重が与えられることで生じる変位に基づいて、物理モデルを構成するモデル構成部(422)と、
前記アクチュエータが前記物理モデルに従う変位を生じるように、前記モータへの制御指令を生成する第1の指令生成部(426)と、
バネ定数を決定する決定部(430)と、
前記バネ定数と前記アクチュエータに生じている変位との積に基づいて算出される駆動力を生じるように、前記モータへの制御指令を生成する第2の指令生成部(428)と、
前記第1の指令生成部および前記第2の指令生成部とのうちいずれからの制御指令を有効化するのかを選択する選択部(436)とを含む、駆動システム。
前記選択部は、前記第1の指令生成部からの制御指令を有効化しているときに、所定の切替条件が満たされると、前記第2の指令生成部からの制御指令を有効化する、構成1に記載の駆動システム。
前記切替条件は、前記アクチュエータに外部からの荷重が与えられてからの経過時間に基づく、構成2に記載の駆動システム。
前記切替条件は、前記アクチュエータに生じている変位に基づく、構成2に記載の駆動システム。
前記第1の指令生成部は、前記モータの目標位置を指定する位置指令を前記制御指令として出力し、
前記第2の指令生成部は、前記モータが発生すべきトルクを指定するトルク指令を前記制御指令として出力する、構成1~4のいずれか1項に記載の駆動システム。
前記モデル構成部は、前記アクチュエータに外部から所定の荷重が与えられると、前記物理モデルを構成する、構成1~5のいずれか1項に記載の駆動システム。
前記決定部は、制御周期毎にバネ定数を設定する、構成1~6のいずれか1項に記載の駆動システム。
モータ(18)により駆動されて変位を生じるアクチュエータ(2)の制御方法であって、
前記アクチュエータに外部からの荷重が与えられることで生じる変位に基づいて、物理モデルを構成するステップ(S4,S6,S8)と、
バネ定数を決定するステップ(S20)と、
前記アクチュエータが前記物理モデルに従う変位を生じるように、前記モータを制御するステップ(S10,S12)と、
前記アクチュエータが前記物理モデルに従う変位を生じるように、前記モータを制御しているときに、所定の切替条件が満たされると、前記バネ定数と前記アクチュエータに生じている変位との積に基づいて算出される駆動力を生じるように、前記モータの制御を切り替えるステップ(S22,S24,S26,S28)とを備える、制御方法。
モータ(18)により駆動されて変位を生じるアクチュエータ(2)を制御するための制御プログラム(412)であって、前記制御プログラムはコンピュータ(40)に、
前記アクチュエータに外部からの荷重が与えられることで生じる変位に基づいて、物理モデルを構成するステップ(S4,S6,S8)と、
バネ定数を決定するステップ(S20)と、
前記アクチュエータが前記物理モデルに従う変位を生じるように、前記モータを制御するステップ(S10,S12)と、
前記アクチュエータが前記物理モデルに従う変位を生じるように、前記モータを制御しているときに、所定の切替条件が満たされると、前記バネ定数と前記アクチュエータに生じている変位との積に基づいて算出される駆動力を生じるように、前記モータの制御を切り替えるステップ(S22,S24,S26,S28)とを実行させる、制御プログラム。
Claims (9)
- モータにより駆動されて変位を生じるアクチュエータと、
前記モータを駆動するドライバと、
前記ドライバに制御指令を与えるコントローラとを備え、
前記コントローラは、
前記アクチュエータに外部からの荷重が与えられることで生じる変位に基づいて、物理モデルを構成するモデル構成部と、
前記アクチュエータが前記物理モデルに従う変位を生じるように、前記モータへの制御指令を生成する第1の指令生成部と、
バネ定数を決定する決定部と、
前記バネ定数と前記アクチュエータに生じている変位との積に基づいて算出される駆動力を生じるように、前記モータへの制御指令を生成する第2の指令生成部と、
前記第1の指令生成部および前記第2の指令生成部とのうちいずれからの制御指令を有効化するのかを選択する選択部とを含む、駆動システム。 - 前記選択部は、前記第1の指令生成部からの制御指令を有効化しているときに、所定の切替条件が満たされると、前記第2の指令生成部からの制御指令を有効化する、請求項1に記載の駆動システム。
- 前記切替条件は、前記アクチュエータに外部からの荷重が与えられてからの経過時間に基づく、請求項2に記載の駆動システム。
- 前記切替条件は、前記アクチュエータに生じている変位に基づく、請求項2に記載の駆動システム。
- 前記第1の指令生成部は、前記モータの目標位置を指定する位置指令を前記制御指令として出力し、
前記第2の指令生成部は、前記モータが発生すべきトルクを指定するトルク指令を前記制御指令として出力する、請求項1~4のいずれか1項に記載の駆動システム。 - 前記モデル構成部は、前記アクチュエータに外部から所定の荷重が与えられると、前記物理モデルを構成する、請求項1~5のいずれか1項に記載の駆動システム。
- 前記決定部は、制御周期毎にバネ定数を設定する、請求項1~6のいずれか1項に記載の駆動システム。
- モータにより駆動されて変位を生じるアクチュエータの制御方法であって、
前記アクチュエータに外部からの荷重が与えられることで生じる変位に基づいて、物理モデルを構成するステップと、
バネ定数を決定するステップと、
前記アクチュエータが前記物理モデルに従う変位を生じるように、前記モータを制御するステップと、
前記アクチュエータが前記物理モデルに従う変位を生じるように、前記モータを制御しているときに、所定の切替条件が満たされると、前記バネ定数と前記アクチュエータに生じている変位との積に基づいて算出される駆動力を生じるように、前記モータの制御を切り替えるステップとを備える、制御方法。 - モータにより駆動されて変位を生じるアクチュエータを制御するための制御プログラムであって、前記制御プログラムはコンピュータに、
前記アクチュエータに外部からの荷重が与えられることで生じる変位に基づいて、物理モデルを構成するステップと、
バネ定数を決定するステップと、
前記アクチュエータが前記物理モデルに従う変位を生じるように、前記モータを制御するステップと、
前記アクチュエータが前記物理モデルに従う変位を生じるように、前記モータを制御しているときに、所定の切替条件が満たされると、前記バネ定数と前記アクチュエータに生じている変位との積に基づいて算出される駆動力を生じるように、前記モータの制御を切り替えるステップとを実行させる、制御プログラム。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202180087069.0A CN116670990A (zh) | 2021-01-15 | 2021-03-09 | 驱动系统、控制方法以及控制程序 |
KR1020237021327A KR20230110600A (ko) | 2021-01-15 | 2021-03-09 | 구동 시스템, 제어 방법 및 기록 매체 |
EP21919453.7A EP4280430A1 (en) | 2021-01-15 | 2021-03-09 | Drive system, control method, and control program |
US18/270,265 US20240058958A1 (en) | 2021-01-15 | 2021-03-09 | Drive system, control method, and control program |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021004649A JP2022109385A (ja) | 2021-01-15 | 2021-01-15 | 駆動システム、制御方法および制御プログラム |
JP2021-004649 | 2021-01-15 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2022153560A1 true WO2022153560A1 (ja) | 2022-07-21 |
Family
ID=82447083
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2021/009172 WO2022153560A1 (ja) | 2021-01-15 | 2021-03-09 | 駆動システム、制御方法および制御プログラム |
Country Status (6)
Country | Link |
---|---|
US (1) | US20240058958A1 (ja) |
EP (1) | EP4280430A1 (ja) |
JP (1) | JP2022109385A (ja) |
KR (1) | KR20230110600A (ja) |
CN (1) | CN116670990A (ja) |
WO (1) | WO2022153560A1 (ja) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006074987A (ja) | 2004-06-18 | 2006-03-16 | Bose Corp | 電気機械式変換装置 |
JP2006125633A (ja) | 2004-10-29 | 2006-05-18 | Bose Corp | 能動型懸架方式 |
JP2009119904A (ja) * | 2007-11-12 | 2009-06-04 | Toyota Motor Corp | 車両用電気サスペンションシステム |
JP2013521443A (ja) | 2010-03-26 | 2013-06-10 | ボーズ・コーポレーション | 回転動作を直線動作に変換するための機構を含むアクチュエータ |
WO2019187223A1 (ja) * | 2018-03-27 | 2019-10-03 | 日立オートモティブシステムズ株式会社 | サスペンション制御装置 |
JP2019209781A (ja) * | 2018-06-01 | 2019-12-12 | 本田技研工業株式会社 | 電磁サスペンション装置 |
JP2020175729A (ja) * | 2019-04-16 | 2020-10-29 | 本田技研工業株式会社 | 電動サスペンション装置 |
-
2021
- 2021-01-15 JP JP2021004649A patent/JP2022109385A/ja active Pending
- 2021-03-09 EP EP21919453.7A patent/EP4280430A1/en active Pending
- 2021-03-09 US US18/270,265 patent/US20240058958A1/en active Pending
- 2021-03-09 WO PCT/JP2021/009172 patent/WO2022153560A1/ja active Application Filing
- 2021-03-09 KR KR1020237021327A patent/KR20230110600A/ko unknown
- 2021-03-09 CN CN202180087069.0A patent/CN116670990A/zh active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006074987A (ja) | 2004-06-18 | 2006-03-16 | Bose Corp | 電気機械式変換装置 |
JP2006125633A (ja) | 2004-10-29 | 2006-05-18 | Bose Corp | 能動型懸架方式 |
JP2009119904A (ja) * | 2007-11-12 | 2009-06-04 | Toyota Motor Corp | 車両用電気サスペンションシステム |
JP2013521443A (ja) | 2010-03-26 | 2013-06-10 | ボーズ・コーポレーション | 回転動作を直線動作に変換するための機構を含むアクチュエータ |
WO2019187223A1 (ja) * | 2018-03-27 | 2019-10-03 | 日立オートモティブシステムズ株式会社 | サスペンション制御装置 |
JP2019209781A (ja) * | 2018-06-01 | 2019-12-12 | 本田技研工業株式会社 | 電磁サスペンション装置 |
JP2020175729A (ja) * | 2019-04-16 | 2020-10-29 | 本田技研工業株式会社 | 電動サスペンション装置 |
Also Published As
Publication number | Publication date |
---|---|
CN116670990A (zh) | 2023-08-29 |
EP4280430A1 (en) | 2023-11-22 |
JP2022109385A (ja) | 2022-07-28 |
KR20230110600A (ko) | 2023-07-24 |
US20240058958A1 (en) | 2024-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Choi et al. | Design of a robot joint with variable stiffness | |
Bicchi et al. | Fast and" soft-arm" tactics [robot arm design] | |
US8138693B2 (en) | Vibration isolation control system | |
JP4217210B2 (ja) | 高周波数の多自由度振動試験機械 | |
JP6775029B2 (ja) | アクティブ慣性ダンパシステムおよび方法 | |
Yildirim et al. | An integrated design approach for a series elastic actuator: Stiffness formulation, fatigue analysis, thermal management | |
JP2011041995A (ja) | ロボット、2足歩行ロボット及びこれらの制御方法 | |
WO2022153560A1 (ja) | 駆動システム、制御方法および制御プログラム | |
WO2022153562A1 (ja) | 製造装置、制御方法および制御プログラム | |
WO2022153563A1 (ja) | 駆動システム、制御方法および制御プログラム | |
WO2022153561A1 (ja) | 駆動システム、制御方法および制御プログラム | |
KR20120001068A (ko) | 복합형 방진 마운트 시스템 | |
WO2013141228A1 (ja) | 振動低減装置 | |
JP4940472B2 (ja) | アクティブ除振装置及び制振装置 | |
US10640210B2 (en) | Method and apparatus for cable-driven adaptive vibration control | |
Bartel et al. | Development and testing of active vibration control systems with piezoelectric actuators | |
Wang et al. | Experimental identification and active control of configuration dependent linkage vibration in a planar parallel robot | |
JP2007198827A (ja) | モーションベースの荷重付与治具 | |
JPH07127306A (ja) | 振動制御装置 | |
JP4743663B2 (ja) | 除振装置及び除振方法 | |
JP4185485B2 (ja) | 振動制御装置 | |
JP2000314442A (ja) | アクティブ制振装置 | |
Bartel et al. | Modelling of an Active Mounted Plate by means of the Superposition of a Rigid Body and an Elastic Model | |
Kizu et al. | Horizontal Counter Control Method for Suppressing Vibration of Machine Base | |
CN112345189A (zh) | 振动模拟实验台及其控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 21919453 Country of ref document: EP Kind code of ref document: A1 |
|
WWE | Wipo information: entry into national phase |
Ref document number: 202180087069.0 Country of ref document: CN |
|
ENP | Entry into the national phase |
Ref document number: 20237021327 Country of ref document: KR Kind code of ref document: A |
|
WWE | Wipo information: entry into national phase |
Ref document number: 18270265 Country of ref document: US |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
ENP | Entry into the national phase |
Ref document number: 2021919453 Country of ref document: EP Effective date: 20230816 |