A flexible manipulator and detection method thereof
By using the control module in the flexible robot to detect the current of the stepper motor and identify the status of the clamping arm, the problem of insufficient detection during the clamping process of the existing robot is solved, efficient clamping and fault warning is achieved, and the work of the robot is improved. Efficiency and object protection.
Patent Information
- Application Number
- CN202311440214.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2023-11-01
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2043-11-01
AI Technical Summary
The existing robots lack effective detection methods during the clamping process, which leads to low gripping efficiency and easy to cause object clamping, making it impossible to effectively monitor the clamping process.
A flexible robot is designed, and the control module uses a control module to determine the clamping state of the clamping arm by detecting the current of the driving component, including the main control unit, the power module, the driving unit and the alarm module, and the clamping arm is identified through the current change of the stepper motor. Contact, clamping and non-contact states to achieve real-time monitoring of clamping force.
It realizes accurate detection of the working status of the flexible robot, improves the clamping efficiency, avoids object damage, and prompts potential faults through the alarm mechanism, improving the working efficiency and reliability of the robot.
Smart Images

Figure CN117325204B_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of flexible manipulators, and in particular relates to a flexible manipulator and a detection method thereof. Background Art
[0002] In existing electronic production lines, robots are generally used to grasp objects for transfer or further processing. However, existing robots do not have a reasonable detection method to monitor and detect the clamped objects, resulting in the inability to effectively monitor and improve the clamping process, reducing the grasping efficiency and easily causing the objects to be damaged.
[0003] There are no relevant solutions to the technical problems existing in the above-mentioned manipulators; therefore, there is an urgent need to find effective solutions to solve the above-mentioned problems. Summary of the invention
[0004] The purpose of the present invention is to address the deficiencies in the above-mentioned technologies and to propose a flexible manipulator and a detection method thereof, in order to solve the problems of gripping detection of existing manipulators.
[0005] The present invention provides a flexible manipulator, which comprises a control module, a driving component, a support frame and a clamping arm; the clamping arm comprises a first clamping arm and a second clamping arm, the first clamping arm and the second clamping arm are respectively rotatably connected to the support frame, and can relatively clamp or open, thereby clamping or loosening an object; the driving component is arranged on the support frame, and is respectively transmission-connected to the first clamping arm and the second clamping arm through a transmission component, and can drive the first clamping arm and the second clamping arm to relatively clamp or open; the control module is electrically connected to the driving component; the control module determines the clamping force between the first clamping arm and the second clamping arm by detecting the current of the driving component, thereby determining the clamping state of the first clamping arm and the second clamping arm.
[0006] Further, the control module includes a main control unit; the driving component is a stepper motor; the main control unit is configured to detect the current I of the stepper motor; the clamping force between the first clamping arm and the second clamping arm is F; the current I and the clamping force F satisfy: .
[0007] Furthermore, the control module also includes a power module, a drive unit and an alarm module. The power module is used to provide V power to the stepper motor; the power module is also used to provide .V power to the main control unit; the power module is also used to provide V power to the drive unit; the drive unit is used to provide a drive signal to the stepper motor; the main control unit is also used to provide a PWM signal to the drive unit; further, the alarm module is configured to detect that the current I of the stepper motor does not meet the preset time. An alarm is sounded; further, the stepper motor converts the electrical pulse signal into angular displacement or linear displacement; the relationship between the angle w of the first clamping arm and the second clamping arm and the number of pulses N satisfies: w=0.361*N.
[0008] Furthermore, the pulse number and current of the stepper motor satisfy the following relationship:
[0009] ; x represents the number of pulses, and y represents the current.
[0010] Further, when the current I of the stepper motor is at 0.005±0.001A, the first clamping arm and the second clamping arm are in a non-contact state;
[0011] When the current I of the stepper motor is at 0.1±0.02A, the first clamping arm and the second clamping arm are in contact with the object;
[0012] When the current I of the stepper motor is at 0.5±0.1A, the first clamping arm and the second clamping arm are in a clamping state.
[0013] Furthermore, the support frame is provided with a first support arm, a second support arm and a transmission frame; the transmission assembly is a screw assembly, and the driving component is a stepper motor; the first support arm is connected to the first clamping arm through the first support plate, and the first support arm and the first clamping arm can respectively rotate on the first support plate; the second support arm is transmission-connected to the second clamping arm through the second support plate, and the second support arm and the second clamping arm can respectively rotate on the second support plate; one end of the transmission frame is transmission-connected to the first clamping arm, and the other end of the transmission frame is transmission-connected to the second clamping arm; one end of the screw assembly is connected to the output end of the stepper motor, and the other end of the screw assembly is connected to the transmission frame; the stepper motor drives the transmission frame to telescopically move through the screw assembly, so that the transmission frame can drive the first clamping arm and the second clamping arm to clamp or open.
[0014] Furthermore, the first support arm is rotatably connected to one end of the first support plate through a rotating joint, and one end of the first clamp arm is rotatably connected to the other end of the first support plate through a rotating joint; the second support arm is transmission-connected to the second clamp arm through the second support plate; the second support arm is rotatably connected to one end of the second support plate through a rotating joint, and one end of the second clamp arm is rotatably connected to the other end of the second support plate through a rotating joint.
[0015] Furthermore, a first transmission rod is provided at one end of the transmission frame, one end of the first transmission rod is rotatably connected to one end of the transmission frame, and the other end of the first transmission rod is rotatably connected to the first clamping arm; a second transmission rod is provided at the other end of the transmission frame, one end of the second transmission rod is rotatably connected to the other end of the transmission frame, and the other end of the second transmission rod is rotatably connected to the second clamping arm.
[0016] Furthermore, the screw assembly includes a screw and a nut; the nut is fixedly arranged at the middle position of both ends of the transmission frame; one end of the screw is connected to the output end of the stepper motor, and the other end of the screw is threadedly connected to the nut, thereby being able to drive the transmission frame to telescopically move.
[0017] Furthermore, the first clamp arm and the second clamp arm are respectively made of stainless steel; the opposite surfaces of the first clamp arm and the second clamp arm are respectively provided with jackets, and the jackets are made of silicone.
[0018] Accordingly, in combination with the above solution, the present invention also provides a detection method for a flexible manipulator, the detection method comprising the following process:
[0019] S1: The driving component starts the relative movement of the first clamping arm and the second clamping arm of the flexible manipulator through the transmission assembly;
[0020] S2: The control module starts to detect the current I of the driving component;
[0021] S3: When the current I of the driving component is at 0.005±0.001A, the first clamping arm and the second clamping arm are in a non-contact state;
[0022] S4: when the current I of the driving component is at 0.1±0.02A, the first clamping arm and the second clamping arm are in contact with the object;
[0023] S5: When the current I of the driving component is at 0.5±0.1A, the first clamping arm and the second clamping arm are in a clamping state.
[0024] Further, the control module includes a main control unit, the driving component is a stepper motor; the main control unit is configured to detect the current I of the stepper motor; the clamping force between the first clamping arm and the second clamping arm is F; the currents I and F satisfy: .
[0025] Furthermore, when the first clamping arm and the second clamping arm are in a clamping state and return to a non-contact state within a preset time, it is determined that the object is in a slipping state, and the alarm module issues an alarm prompt; the preset time is designed to be 450ms to 550ms.
[0026] Furthermore, after detecting that the current I of the stepper motor meets the requirements, it also includes detecting whether the stepper motor runs to a preset position. When the stepper motor is at the preset position, the stepper motor is reset; when the stepper motor is not at the preset position, the current of the stepper motor is re-detected.
[0027] The solution provided by the present invention has a relatively novel design and can accurately detect the working state of the flexible manipulator, thereby achieving efficient control and improving the working efficiency of the flexible manipulator. BRIEF DESCRIPTION OF THE DRAWINGS
[0028] The present invention will be further described in detail below in conjunction with the accompanying drawings and specific embodiments.
[0029] The present invention will be further described below in conjunction with the accompanying drawings:
[0030] Figure 1 This is a schematic diagram of the structure of a flexible manipulator of the present invention;
[0031] Figure 2 This is a schematic diagram of a hand detection module of a flexible machine of the present invention;
[0032] Figure 3 The working principle of the stepping motor of the present invention is Figure 1 ;
[0033] Figure 4 The working principle of the stepping motor of the present invention is Figure 2 ;
[0034] Figure 5 This is a flow chart of a detection method of a flexible manipulator of the present invention;
[0035] Figure 6 This is a corresponding diagram of the current and pulse of the stepping motor of the present invention.
[0036] In the figure: 1. support frame; 11. first support arm; 12. second support arm; 2. first clamping arm; 3. second clamping arm; 4. screw; 5. first support plate; 6. second support plate; 7. jacket; 8. rotating joint; 9. transmission frame; 91. first transmission rod; 92. second transmission rod; 10. stepping motor. DETAILED DESCRIPTION
[0037] In order to make the technical problems, technical solutions and beneficial effects to be solved by the present invention more clearly understood, the present invention is further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the present invention and are not intended to limit the present invention.
[0038] It should be noted that when an element is referred to as being "fixed to" or "disposed on" another element, it can be directly on the other element or indirectly on the other element. When an element is referred to as being "connected to" another element, it can be directly connected to the other element or indirectly connected to the other element.
[0039] In addition, the terms "first" and "second" are used for descriptive purposes only and should not be understood as indicating or implying relative importance or implicitly indicating the number of the indicated technical features. Therefore, the features defined as "first" and "second" may explicitly or implicitly include one or more of the features. In the description of the present invention, the meaning of "multiple" is two or more, unless otherwise clearly and specifically defined. The meaning of "several" is one or more, unless otherwise clearly and specifically defined.
[0040] In the description of the present invention, it is necessary to understand that the directions or positional relationships indicated by the terms "up", "down", "front", "back", "left", "right", etc. are based on the directions or positional relationships shown in the accompanying drawings, and are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific direction, be constructed and operated in a specific direction, and therefore cannot be understood as a limitation on the present invention.
[0041] In the description of the present invention, it should be noted that, unless otherwise clearly specified and limited, the terms "installed", "connected", and "connected" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection or an indirect connection through an intermediate medium, it can be the internal connection of two elements or the interaction relationship between two elements. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0042] As shown in Figure 1 to Figure 2 As shown, the present invention provides a flexible manipulator, which is preferably used for clamping electronic objects such as diodes; specifically, the flexible manipulator includes a control module, a driving component, a support frame 1 and a clamping arm; wherein the clamping arm includes a first clamping arm 2 and a second clamping arm 3, the first clamping arm 2 and the second clamping arm 3 are respectively rotatably connected to the support frame 1, and can be relatively clamped or opened, thereby clamping or loosening an object, which is preferably a diode; further, the driving component is arranged on the support frame 1, and is respectively transmission-connected to the first clamping arm 2 and the second clamping arm 3 through a transmission component, and can drive the first clamping arm 2 and the second clamping arm 3 to clamp or open relative to each other; further, the control module is electrically connected to the driving component; the control module determines the clamping force F between the first clamping arm 2 and the second clamping arm 3 by detecting the current I of the driving component, thereby determining the clamping state of the first clamping arm 2 and the second clamping arm 3; adopting the above-mentioned design scheme, the clamping state of the manipulator is determined by detecting the current I of the driving component, so that the working state of the flexible manipulator can be designed, efficient clamping can be achieved, damage to objects can be avoided, and effectiveness can be improved.
[0043] Preferably, in combination with the above scheme, as shown in Figures 1 to Figure 2 As shown, in this embodiment, the control module includes a main control unit, which is based on STM32F103 and has the characteristics of high performance, low power consumption, and convenient development; further, the driving component is a stepper motor 10; wherein the main control unit is configured to detect the current I of the stepper motor 10, and the current I of the stepper motor 10 is proportional to the torque T; specifically, the clamping force between the first clamping arm 2 and the second clamping arm 3 is F; the torque T is proportional to the clamping force F transmitted to the clamped object through the transmission component; therefore, according to equations ① and ②, equation ③ can be obtained, that is:
[0044] ; K1 and K2 are transmission coefficients respectively. The performance of the stepper motor and the size analysis of the transmission mechanism show that K1 is designed to be 0.2; K2 is designed to be 0.5;
[0045] Therefore, it can be concluded that the current I and the clamping force F satisfy:
[0046] ;
[0047] Specifically, according to a specific embodiment: the maximum external force that the clamped object can withstand is 10N, leaving a 50% safety margin, so the maximum gripping force is set to 5N; the maximum static friction coefficient of the silicone jacket of the manipulator is u=0.7, and the maximum static friction F max is 3.5N, gravity G is 0.01N, then F max If the angle w of the robot arm and the number of pulses N is fixed, the relationship between the angle w of the robot arm and the number of pulses N satisfies: w=0.361*N; Specifically, the relationship between the number of pulses and the current is the relationship between the closing angle of the robot arm and the force on the clamped object. Figure 6 shown.
[0048] Preferably, in combination with the above scheme, as shown in Figures 1 to Figure 2 As shown, the control module also includes a power module, a drive unit and an alarm module; the power module mainly converts the mains electricity into 12V, 5V and 3.3V for use by other modules, specifically: the power module is used to provide 12V power to the stepper motor 10; the power module is also used to provide 3.3V power to the main control unit; the power module is also used to provide 5V power to the drive unit; further, the drive module, MS35774 has high operating voltage, large operating current, and a current of up to 2A. It integrates over-temperature protection and over-current protection, and the output can also run in parallel at high load current. The drive unit is used to provide a drive signal to the stepper motor 10; further, the stepper motor is an open-loop control element stepper motor device that converts an electrical pulse signal into an angular displacement or a linear displacement; further, the alarm module is configured to detect that the current I of the stepper motor 10 does not meet the preset time. An alarm is sounded.
[0049] Preferably, in combination with the above scheme, under non-overload conditions, the speed and stop position of the stepper motor depend only on the frequency and number of pulses of the pulse signal, and are not affected by load changes; when the stepper driver receives a pulse signal, it drives the stepper motor to rotate a fixed angle in the set direction, called the "step angle", and its rotation runs step by step at a fixed angle, so that the angular displacement can be controlled by controlling the number of pulses, thereby achieving the purpose of accurate positioning; specifically, taking a two-phase four-beat stepper motor as an example, Figure 3 and Figure 4 As shown, by energizing phase A and phase B alternately, the motor will rotate in a specific direction, 90° each time.
[0050] Preferably, in combination with the above solution, the pulse number X and the current y of the stepper motor 10 satisfy the following relationship:
[0051] ; That is, x represents the number of pulses and y represents the current.
[0052] Specifically, from the above formula and Figure 6 It can be analyzed that, based on the relationship between the pulse number X and the current y of the stepper motor 10, the clamping process is divided into three stages in total:
[0053] The first stage: the pre-clamping process before the 14th pulse, at this time, the manipulator is not in contact with the clamped object, the force on the clamped object is oriented to 0, and the current is extremely small, which is the motor operation maintenance current; at this time, the current I should be 0.005±0.001A, otherwise it indicates that the motor is not working properly or the manipulator is stuck; that is, when the current I of the stepper motor 10 is 0.005±0.001A, the first clamping arm 2 and the second clamping arm 3 are in a non-contact state;
[0054] The second stage: from the 14th pulse to the 16th pulse, the robot arm makes initial contact with the clamped object, and the current gradually increases. At the 16th pulse, the current I should be 0.1±0.02A, corresponding to a pressure of 0.8~1.2N, otherwise it indicates that the silicone jacket of the robot arm has fallen off or the robot arm is stuck; when the current I of the stepper motor 10 is at 0.1±0.02A, the first clamp arm 2 and the second clamp arm 3 are in contact with the object;
[0055] The third stage: from the 16th pulse to the 20th pulse, the contact area between the robot arm and the clamped object gradually increases. The current I detected at the 20th pulse should be 0.5±0.1A, corresponding to a pressure of 4~6N. The clamping action is completed at this time, otherwise it indicates that the clamping process has failed and the motor or robot arm needs to be checked. When the current I of the stepper motor 10 is at 0.5±0.1A, the first clamping arm 2 and the second clamping arm 3 are in a clamping state.
[0056] Preferably, in combination with the above solution, when the first clamping arm 2 and the second clamping arm 3 are in a clamped state and instantly recover to a non-contact state, it is determined that the object is in a sliding state, and the alarm module issues an alarm prompt.
[0057] Preferably, in combination with the above scheme, as shown in Figure 1, the support frame 1 is provided with a first support arm 11, a second support arm 12 and a transmission frame 9; the transmission assembly is preferably a screw assembly, and the driving component is specifically a stepper motor 10; specifically, the first support arm 11 is connected to the first clamping arm 2 through the first support plate 5, and the first support arm 11 and the first clamping arm 2 can respectively rotate on the first support plate 5, thereby achieving clamping; correspondingly, the second support arm 12 is transmission-connected to the second clamping arm 3 through the second support plate 6, and the second support arm 12 and the second clamping arm 3 can respectively rotate on the second support plate 6, thereby achieving clamping; further, one end of the transmission frame 9 is transmission-connected to the first clamping arm 2, and the other end of the transmission frame 9 is transmission-connected to the second clamping arm 3; further, one end of the screw assembly is connected to the output end of the stepper motor 10, and the other end of the screw assembly is connected to the transmission frame 9; specifically, the stepper motor 10 drives the transmission frame 9 to telescopically move through the screw assembly, so that the transmission frame 9 can drive the first clamping arm 2 and the second clamping arm 3 to clamp or open.
[0058] Preferably, in combination with the above scheme, as shown in Figure 1, the first support arm 11 is rotatably connected to one end of the first support plate 5 through a rotating joint 8, and one end of the first clamping arm 2 is rotatably connected to the other end of the first support plate 5 through a rotating joint 8; accordingly, the second support arm 12 is transmission-connected to the second clamping arm 3 through the second support plate 6; the second support arm 12 is rotatably connected to one end of the second support plate 6 through a rotating joint 8, and one end of the second clamping arm 3 is rotatably connected to the other end of the second support plate 6 through a rotating joint 8; the rotating connection of the above-mentioned rotating joint is adopted, so that the screw assembly can drive the transmission frame 9 to telescopically move, so that the transmission frame 9 can drive the first clamping arm 2 and the second clamping arm 3 to rotate around the rotating joint 8, thereby achieving clamping or opening.
[0059] Preferably, in combination with the above scheme, as shown in Figure 1, a first transmission rod 91 is provided at one end of the transmission frame 9, one end of the first transmission rod 91 is rotatably connected to one end of the transmission frame 9, and the other end of the first transmission rod 91 is rotatably connected to the first clamping arm 2; accordingly, a second transmission rod 92 is provided at the other end of the transmission frame 9, one end of the second transmission rod 92 is rotatably connected to the other end of the transmission frame 9, and the other end of the second transmission rod 92 is rotatably connected to the second clamping arm 3; the above-mentioned transmission rod design is adopted, so that the screw rod 4 can simultaneously drive the first clamping arm 2 and the second clamping arm 3 to rotate around the rotating joint 8 when extending and retracting, thereby achieving clamping or opening.
[0060] Preferably, in combination with the above scheme, as shown in Figure 1, the screw assembly includes a screw 4 and a nut; specifically, the nut is fixedly arranged at the middle position of the two ends of the transmission frame 9 to play a balancing role; further, one end of the screw 4 is connected to the output end of the stepper motor 10, and the other end of the screw 4 is threadedly connected to the nut, thereby being able to drive the transmission frame 9 to telescopically move, and then drive the first clamping arm 2 and the second clamping arm 3 to rotate around the rotating joint 8, thereby achieving clamping or opening.
[0061] Preferably, in combination with the above scheme, as shown in Figure 1, the first clamp arm 2 and the second clamp arm 3 are made of stainless steel materials respectively; further, the opposite surfaces of the first clamp arm 2 and the second clamp arm 3 are respectively provided with jackets 7, the material of the jacket 7 is 70 degree silicone, and the clamping surface of the jacket 7 is a mesh surface, which can increase friction. The use of silicone jacket design can be beneficial to the clamping and protection of objects, avoid uneven force and damage to objects.
[0062] Accordingly, in combination with the above scheme, as shown in Figures 1 to Figure 5 As shown, the present invention also provides a detection method for a flexible manipulator, specifically the detection method for the flexible manipulator described above; specifically, the detection method mainly detects the current during the operation of the driving component, and judges whether the current meets the regulations by comparing the setting relationship of the step current, and judges the size of the clamping force F, so as to identify missed clamping, fault, crushing and normal operation process; the detection method includes the following process:
[0063] S1: Start detection through the start signal of the stepper motor. When it is determined that the stepper motor is in the start state, the stepper motor starts the relative movement of the first clamping arm 2 and the second clamping arm 3 of the flexible manipulator through the transmission component;
[0064] S2: The control module starts to detect the current I of the stepper motor and determines whether the current I of the stepper motor meets the requirements;
[0065] S3: When the current I of the stepper motor is at 0.005±0.001A, the first clamping arm 2 and the second clamping arm 3 are in a non-contact state;
[0066] S4: When the current I of the stepper motor is at 0.1±0.02A, the first clamping arm 2 and the second clamping arm 3 are in contact with an object;
[0067] S5: When the current I of the stepper motor is at 0.5±0.1A, the first clamping arm 2 and the second clamping arm 3 are in a clamping state.
[0068] Preferably, in combination with the above solution, as shown in FIG2 , the control module includes a main control unit; the main control unit is configured to detect the current I of the stepper motor 10; the clamping force between the first clamping arm 2 and the second clamping arm 3 is F; the current I and the clamping force F satisfy:
[0069] ; For the specific derivation of the current I and the clamping force F, please refer to the above embodiment.
[0070] Preferably, in combination with the above scheme, when the first clamping arm 2 and the second clamping arm 3 are in a clamping state and return to a non-contact state within a preset time, it is judged that the object is in a sliding state, and the alarm module issues an alarm prompt; specifically, the preset time is designed to be 450ms to 550ms, preferably designed to be 500ms.
[0071] Preferably, in combination with the above scheme, after step S2, when it is detected that the current I of the stepper motor 10 meets the requirements, it also includes detecting whether the stepper motor 10 runs to a preset position. When the stepper motor 10 is at the preset position, the stepper motor 10 is reset; when the stepper motor 10 is not at the preset position, the current of the stepper motor 10 is re-detected.
[0072] The solution provided by the present invention has a relatively novel design and can accurately detect the working state of the flexible manipulator, thereby achieving efficient control and improving the working efficiency of the flexible manipulator.
[0073] The above is only a preferred embodiment of the present invention and does not limit the present invention in any form. Any technician familiar with the art can make many possible changes and modifications to the technical solution of the present invention by using the above-mentioned technical content without departing from the scope of the technical solution of the present invention, or modify it into an equivalent embodiment of equivalent changes. Therefore, any changes, modifications, equivalent changes and modifications made to the above embodiments based on the technology of the present invention without departing from the content of the technical solution of the present invention belong to the protection scope of the present technical solution.
Claims
1. A flexible manipulator, characterized in that: The flexible manipulator comprises a control module, a driving component, a support frame (1) and a clamping arm; the clamping arm comprises a first clamping arm (2) and a second clamping arm (3); the first clamping arm (2) and the second clamping arm (3) are respectively rotatably connected to the support frame (1) and are capable of relatively clamping or opening, thereby clamping or releasing an object; the driving component is arranged on the support frame (1) and is respectively transmission-connected to the first clamping arm (2) and the second clamping arm (3) through a transmission component, and is capable of driving the first clamping arm (2) and the second clamping arm (3) to relatively clamp or open; the control module is electrically connected to the driving component; the control module determines the clamping force between the first clamping arm (2) and the second clamping arm (3) by detecting the current of the driving component, thereby determining the clamping state of the first clamping arm (2) and the second clamping arm (3); The control module comprises a main control unit; the driving component is a stepper motor (10); the main control unit is configured to detect a current I of the stepper motor (10); the clamping force between the first clamping arm (2) and the second clamping arm (3) is F; the current I and the clamping force F satisfy: I =0.1* F ; The control module further comprises a power module, a drive unit and an alarm module, wherein the power module is used to provide a 12V power supply to the stepper motor (10); the power module is also used to provide a 3.3V power supply to the main control unit; the power module is also used to provide a 5V power supply to the drive unit; the drive unit is used to provide a drive signal to the stepper motor (10); the main control unit is also used to provide a PWM signal to the drive unit; the alarm module is configured to issue an alarm when the current I of the stepper motor (10) is not satisfied within a preset time; the stepper motor (10) converts the electrical pulse signal into an angular displacement or a linear displacement; the relationship between the angle w of the first clamp arm (2) and the second clamp arm (3) and the number of pulses N satisfies: w=0.361*N; The pulse number and current of the stepper motor (10) satisfy the following relationship: ; x represents the number of pulses, and y represents the current; When the current I of the stepper motor (10) is at 0.005±0.001A, the first clamp arm (2) and the second clamp arm (3) are in a non-contact state; when the current I of the stepper motor (10) is at 0.1±0.02A, the first clamp arm (2) and the second clamp arm (3) are in a contact state with an object; and when the current I of the stepper motor (10) is at 0.5±0.1A, the first clamp arm (2) and the second clamp arm (3) are in a clamped state.
2. The flexible manipulator according to claim 1, characterized in that: The support frame (1) is provided with a first support arm (11), a second support arm (12) and a transmission frame (9); the transmission assembly is a screw assembly, and the driving component is a stepping motor (10); the first support arm (11) is connected to the first clamping arm (2) via a first support plate (5), and the first support arm (11) and the first clamping arm (2) are respectively rotatable on the first support plate (5); the second support arm (12) is transmission-connected to the second clamping arm (3) via a second support plate (6), and the second support arm (12) and the second clamping arm ( 3) can rotate on the second support plate (6); one end of the transmission frame (9) is transmission-connected to the first clamping arm (2), and the other end of the transmission frame (9) is transmission-connected to the second clamping arm (3); one end of the screw assembly is connected to the output end of the stepping motor (10), and the other end of the screw assembly is connected to the transmission frame (9); the stepping motor (10) drives the transmission frame (9) to telescopically move through the screw assembly, so that the transmission frame (9) can drive the first clamping arm (2) and the second clamping arm (3) to clamp or open.
3. The flexible manipulator according to claim 2, characterized in that: The first support arm (11) is rotatably connected to one end of the first support plate (5) via a swivel joint (8), and one end of the first clamping arm (2) is rotatably connected to the other end of the first support plate (5) via a swivel joint (8); the second support arm (12) is transmission-connected to the second clamping arm (3) via the second support plate (6); the second support arm (12) is rotatably connected to one end of the second support plate (6) via a swivel joint (8), and one end of the second clamping arm (3) is rotatably connected to the other end of the second support plate (6) via a swivel joint (8).
4. The flexible manipulator according to claim 2, characterized in that: A first transmission rod (91) is provided at one end of the transmission frame (9), one end of the first transmission rod (91) is rotatably connected to one end of the transmission frame (9), and the other end of the first transmission rod (91) is rotatably connected to the first clamping arm (2); a second transmission rod (92) is provided at the other end of the transmission frame (9), one end of the second transmission rod (92) is rotatably connected to the other end of the transmission frame (9), and the other end of the second transmission rod (92) is rotatably connected to the second clamping arm (3); and / or, The screw assembly comprises a screw (4) and a nut; the nut is fixedly arranged at a middle position between two ends of the transmission frame (9); one end of the screw (4) is connected to an output end of the stepping motor (10), and the other end of the screw (4) is threadedly connected to the nut, thereby being able to drive the transmission frame (9) to telescopically move; and / or, The first clamp arm (2) and the second clamp arm (3) are respectively made of stainless steel; the opposing surfaces of the first clamp arm (2) and the second clamp arm (3) are respectively provided with a clamp jacket (7), and the clamp jacket (7) is made of silica gel.
5. The detection method of a flexible manipulator according to claim 1, characterized in that: The detection method The process includes: S1: The driving component starts relative movement of the first clamping arm (2) and the second clamping arm (3) of the flexible manipulator through the transmission assembly; S2: The control module starts to detect the current I of the driving component; S3: when the current I of the driving component is at 0.005±0.001A, the first clamping arm (2) and the second clamping arm (3) are in a non-contact state; S4: when the current I of the driving component is at 0.1±0.02A, the first clamping arm (2) and the second clamping arm (3) are in contact with an object; S5: When the current I of the driving component is at 0.5±0.1A, the first clamping arm (2) and the second clamping arm (3) are in a clamping state.
6. The detection method according to claim 5, characterized in that: The control module comprises a main control unit, the driving component is a stepping motor (10); the main control unit is configured to detect a current I of the stepping motor (10); the clamping force between the first clamping arm (2) and the second clamping arm (3) is F; the current I and F satisfy: I=0.1*F; and / or, When the first clamping arm (2) and the second clamping arm (3) are in a clamped state and return to a non-contact state within a preset time, it is determined that the object is in a sliding state, and the alarm module issues an alarm prompt; the preset time is designed to be 450ms to 550ms; and / or, After detecting that the current I of the stepper motor (10) meets the requirement, the method further includes detecting whether the stepper motor (10) is running. When the stepper motor (10) reaches a preset position, the stepper motor (10) is reset when the stepper motor (10) is at the preset position; when the stepper motor (10) is not at the preset position, the current of the stepper motor (10) is re-detected.
