RIGID-FLEXIBLE COUPLING MOTION PLATFORM DRIVEN BY BALL SCREW AND CONTROL METHOD THEREOF

Abstract

A rigid-flexible coupling motion platform driven by a ball screw includes a base, a linear guide rail fixed to the base, a rigid-flexible coupling platform, a servo motor, a ball screw, a guide rail sliding block, a displacement sensor and a driving controller. The rigid-flexible coupling platform includes a frame and a workbench. The frame and the workbench are connected through a flexible hinge; the servo motor is configured to drive the ball screw; the workbench is connected with the ball screw; the frame is connected with the linear guide rail by the guide rail sliding block; the displacement sensor is configured to feed back the position of the workbench; and the driving controller controls the ball screw to drive the workbench to move according to different control modes. The advantages of the ball screw drive and the rigid-flexible coupling motion platform are fully combined, and the positioning precision of the platform is greatly improved.

Claims

1. A rigid-flexible coupling motion platform driven by a ball screw, comprising: a base, a linear guide rail fixed to the base, a rigid-flexible coupling platform, a servo motor, the ball screw, a guide rail sliding block, a displacement sensor and a driving controller; wherein the rigid-flexible coupling platform comprises a frame and a workbench; and the frame and the workbench are connected though a flexible hinge; the servo motor is configured to drive the ball screw; the workbench is connected with the ball screw; the frame is connected with the linear guide rail by the guide rail sliding block; the displacement sensor is configured to feed back a position of the workbench; and the driving controller is configured to take a planned trajectory as a control target, to form a position loop with the position feedback of the workbench, to form a speed loop with a speed of the servo motor, and to generate a control signal to a current loop to drive the ball screw to drive the workbench to move.

2. A rigid-flexible coupling motion platform driven by a ball screw, comprising: a base, a linear guide rail fixed to the base, a rigid-flexible coupling platform, a servo motor, the ball screw, a guide rail sliding block, a displacement sensor and a driving controller; wherein the rigid-flexible coupling platform comprises a frame and a workbench; and the frame and the workbench are connected through a flexible hinge; the servo motor is configured to drive the ball screw; the workbench is corrected with the ball screw; the frame is connected with the linear guide rail by the guide rail sliding block; the displacement sensor is configured to feed back a position of the workbench; and the driving contoller is configured to take a planned trajectory as a control target, to form a position loop with the position feedback of the workbench, and to form a speed loop with a speed of the servo motor, with a purpose of converting a position of the servo motor into a linear displacement, the position feedback of the workbench is serviced as an actual position, a position deviation and a control signal are taken as inputs to perform an expanded state observation of disturbance estimation and the estimated disturbance is used to modify the control signal; and then the control signal is input to a current loop to drive the ball screw to drive the workbench to move.

3. The rigid-flexible coupling motion platform according to claim 1, wherein the flexible hinge is a spring leaf; the workbench and the spring leaf are connected together by a middle pressing block; and both ends of the spring leaf are pressed together with the frame through two end pressing blocks respectively; the middle pressing block is replaceable with a pressing block of a different width; and pressing positions of the end pressing blocks are changeable.

4. A method for controlling a rigid-flexible coupling motion platform driven by a ball screw, wherein the rigid-flexible coupling motion platform comprises a base, a linear guide rail fixed to the base, a rigid-flexible coupling platform, a servo motor, the ball screw, a guide rail sliding block, a displacement sensor and a driving controller; the rigid-flexible coupling platform comprises a frame and a workbench; and the frame and the workbench are connected through a flexible hinge; the servo motor is configured to drive the ball screw; the workbench is connected with the ball screw; the frame is connected with the linear guide rail by the guide rail sliding block; the displacement sensor is configured to feed back a position of the workbench; the driving controller is configured to control the ball screw to drive the workbench to move; the method comprises: a semi-closed loop control mode, a dual-feedback full-closed loop control mode, and a dual-feedback auto disturbance rejection control mode; in the semi-closed loop control mode, a panned trajectory is taken as a control target, a position loop is formed with a position feedback of the servo motor, a speed loop is formed with a speed of the servo motor, and a control signal is input to a current loop to drive the ball screw to drive the workbench to move; in the dual-feedback full-closed loop control mode, a planned trajectory is taken as a control target and a position loop is formed with the position feedback of the workbench, a speed loop is formed with a speed of the servo motor, and a control signal is input to a current loop to drive the ball screw to drive the workbench to move; in the dual-feedback auto disturbance rejection control mode, a planned trajectory is taken as a control target, a position loop is formed with the position feedback of the workbench, a speed bop is formed with a speed of the servo motor, with a purpose of converting a position of the servo motor into a linear displacement, the position feedback of the workbench is serviced as an actual position, a position deviation and a control signal are taken as inputs to perform the expanded state observation of disturbance estimation and the estimated disturbance is used to modify the control signal; and then the control signal is input to a current loop to drive the ball screw to drive the workbench to move.

5. The method according to claim 4, wherein when precision is required in micron scale, the semi-closed loop control mode is adopted; when the precision is required in sub-micron scale, the dual-feedback full-closed loop control mode is adopted; and when the precision is required in nanoscale, the dual-feedback auto disturbance rejection control mode is adopted.

6. The method according to claim 5, wherein in the micron scale, the precision is greater than 1 m; in the sub-micron scale, the precision is in a range of 0.1-1 m; and in the nano scale, the precision is less than 0.1 m.

7. The rigid-flexible coupling motion platform according to claim 2, wherein the flexible hinge is a spring leaf the workbench and the spring leaf are connected together by a middle pressing block; and both ends of the spring leaf are pressed together with the frame through two end pressing blocks respectively; the middle pressing block is replaceable with a pressing block of a different width; and pressing positions of the end pressing blocks are changeable.

Description

DESCRIPTION OF THE DRAWINGS

[0018] FIG. 1 is an overall schematic diagram of a rigid-flexible coupling motion platform driven by a ball screw;

[0019] FIG. 2 is a local sectional view of a rigid-flexible coupling motion platform driven by a ball screw;

[0020] FIG. 3 is a local sectional view of a rigid-flexible coupling platform;

[0021] FIG. 4 is a local enlarged diagram of a composite flexible hinge in a rigid-flexible coupling platform;

[0022] FIG. 5 shows a semi-closed loop control mode of a rigid-flexible coupling platform driven by a ball screw;

[0023] FIG. 6 shows a dual-feedback control mode of a rigid-flexible coupling platform driven by a ball screw; and

[0024] FIG. 7 shows a dual-feedback auto disturbance rejection control mode of a rigid-flexible coupling platform driven by a ball screw.

DETAILED DESCRIPTION OF PREFERRED EMBODIMENTS

[0025] The drawings are merely used for exemplary illustration, and shall not be understood as a limitation to the disclosure. In order to better illustrate the embodiments, some components in the drawings may be omitted, enlarged or reduced, and do not represent the actual product sizes. It can be understood for those of ordinary skill in the art that some known structures in the drawings and the description may be omitted. The positional relationship described in the drawings is merely used for exemplary illustration, and shall not be understood as a limitation to the disclosure.

Embodiment I

[0026] As shown in FIG. 1 and FIG. 2, a rigid-flexible coupling motion platform driven by a ball screw in the disclosure includes a base 2, a linear guide rail 4, a rigid-flexible coupling platform 7, a servo motor 1, a ball screw 3, a displacement sensor and a driving controller. A frame 701 and a workbench 702 jointly form the rigid-flexible coupling platform 7 through composite flexible hinges 703 and 704. The servo motor 1 is configured to drive the ball screw 3. The ball screw 3 is connected with the workbench 702 in the rigid-flexible coupling platform 7 through a bolt. The frame 701 in the rigid-flexible coupling platform 7 is connected with the linear guide rail 4 by a sliding block. The frame 701 is connected with the sliding block, and slides on the linear guide rail 4 through the sliding block. The displacement sensor includes a displacement sensor reading head 6 and a displacement sensor substrate 5. The displacement sensor reading head 6 is installed on the workbench 702 through a bolt. The displacement sensor substrate 5 is installed on the base 2. The servo motor 1, the ball screw 3 and the linear guide rail 4 are fixed to the base 2 through bolts. The ball screw is driven by the servo motor 1; the ball screw drives the workbench in the rigid-flexible coupling platform 7 to move; and the workbench 702 drives the frame 701 through composite flexible hinges to move on the linear guide rail 4.

[0027] As shown in FIG. 4, the effective length of the flexible hinge 704 is changed by replacing the middle pressing block of a different width for a spring leaf type elastic hinge 704 or adjusting the positions of the pressing blocks at both ends, thereby changing the rigidity of the rigid-flexible coupling platform and adapting to needs under different working conditions.

[0028] FIG. 5 shows a semi-closed loop control mode in which servo motor speed feedback is used to form a speed loop and servo motor displacement feedback is used to form a position loop. A planned trajectory is taken as a control target, a position loop is formed with the position feedback of the servo motor, a speed loop is formed with a speed of the servo motor, and a control signal is generated to a current loop to drive the ball screw to drive the workbench to move. When the displacement is small and a support reaction generated by the elastic deformation of the flexible hinge is insufficient to overcome the friction, the friction dead zone is completely compensated by the elastic deformation, thereby greatly improving the precision. When a stroke is large, the support reaction of the flexible hinge is greater than the friction force, so as to drive the frame to move to achieve a wide range of motion. The precision of the ball screw platform is improved through mechanism design without increasing the control cost.

[0029] The semi-closed loop control mode is the most economical and is suitable for use when the precision is not required to be high, i.e., in micron scale (e.g., greater than 1 m).

Embodiment II

[0030] Like embodiment 1. Embodiment II also uses the rigid-flexible coupling motion platform driven by the ball screw, but adopts a different control mode. The control mode of embodiment 11 is a dual-feedback full-closed loop control mode.

[0031] FIG. 6 shows a full-closed loop control mode in which servo motor speed feedback is used to form a speed loop and servo motor displacement feedback is used to form a position loop. A planned trajectory is taken as a control target, a position loop is formed with the position feedback of the workbench, a speed loop is formed with a speed of the servo motor, and a control signal is generated to a current loop to drive the ball screw to drive the workbench to move. When the displacement is small and a support reaction generated by the elastic deformation of the flexible hinge is insufficient to overcome the friction, the friction dead zone is completely compensated by the elastic deformation, thereby greatly improving the precision. When a stroke is large, the support reaction of the flexible hinge is greater than the friction force, so as to drive the frame to move to achieve a wide range of motion. The precision of the rigid-flexible coupling platform driven by the ball screw is further improved by full-closed loop control.

[0032] The dual-feedback full-closed loop control mode in embodiment II is more suitable for use when the precision is required to be high, i.e., in sub-micron scale (e.g., 0.1-1 m).

Embodiment III

[0033] Like embodiment I, Embodiment III also uses the rigid-flexible coupling motion platform driven by the ball screw, but adopts a different control mode. The control mode of embodiment III is a dual-feedback auto disturbance rejection control mode.

[0034] FIG. 7 shows a realization mode for performing expanded state observation of disturbance estimation and compensating for estimated disturbance by taking an objective of converting a position of a servo motor into a linear displacement, taking a position feedback of a workbench as an actual position and taking a position deviation and a control signal as inputs.

[0035] A planned trajectory is taken as a control target, a position loop is formed with the position feedback of the workbench, and a speed loop is formed with the speed of the servo motor. With a purpose of converting the position of the servo motor into a linear displacement, the position feedback of the workbench is serviced as an actual position, a position deviation and a control signal are taken as inputs to perform the expanded state observation of disturbance estimation, and the estimated disturbance is used to modify the control signal. The control signal is input to a current loop to drive the ball screw to drive the workbench to move. When the displacement is small and a support reaction generated by the elastic deformation of the flexible hinge is insufficient to overcome the friction, the friction dead zone is completely compensated by the elastic deformation, thereby greatly improving the precision. When a stroke is large, the support reaction of the flexible hinge is greater than the friction force, so as to drive the frame to move to achieve a wide range of motion. The auto disturbance rejection algorithm is introduced, which not only improves dynamic performance, but also adapts to load change.

[0036] The dual-feedback auto disturbance rejection control mode in embodiment III is more suitable for use when the precision is required to be very high, i.e., in nanoscale (e.g., less than 0.1 m).

[0037] It is apparent that the above embodiments of the disclosure are merely examples made for clearly describe the disclosure and are not intended to limit the embodiments of the disclosure. Other variations or modifications of the different forms may be made based on the above illustration by those of ordinary skill in the art. There is no need and no way to enumerate all of the embodiments herein. Any modification, equivalent substitution and improvement made within the spirit and principle of the disclosure shall be included within the protection scope of the claims.