The calibration method, storage medium, and clamping mechanism for holding calibration points in the clamping mechanism
By controlling the movement and parameter processing of the clamping components, automated calibration of the clamping calibration points was achieved, solving the problem of inaccurate clamping calibration point positions, reducing calibration costs, and improving task execution success rate.
Patent Information
- Application Number
- CN202311242925.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2023-09-22
- Publication Date
- 2026-11-10
- Estimated Expiration
- 2043-09-22
AI Technical Summary
Inaccurate positioning of the clamping calibration point in the clamping mechanism can affect the success of task execution. Existing technologies lack effective automated calibration methods, resulting in high calibration costs.
By controlling the movement of the clamping components and acquiring the parameters during the movement for simple processing, the automatic calibration of the clamping calibration points is achieved, reducing the need for additional components.
It enables automated calibration of clamping calibration points, reduces calibration costs, and improves the success rate of task execution.
Smart Images

Figure CN118386221B_ABST
Abstract
Description
Technical Field
[0001] This disclosure relates to the field of automation technology, and more specifically, to a calibration method for clamping calibration points in a clamping mechanism, a clamping mechanism controller, a storage medium, and a clamping mechanism. Background Technology
[0002] The clamping components in the clamping mechanism are set to each clamping calibration point. If the position of the clamping calibration point is no longer accurate (e.g., due to aging caused by mechanism movement collisions, structural deformation, etc.), it will have a significant impact on the execution of the task.
[0003] Therefore, in order to ensure the success of the task, it is necessary to calibrate the clamping calibration points in the clamping mechanism. Summary of the Invention
[0004] The purpose of this disclosure is to provide a calibration method for clamping calibration points in a clamping mechanism, a clamping mechanism controller, a storage medium, and a clamping mechanism. By controlling the movement of the clamping components and performing simple processing on the parameters obtained during the movement of the clamping components, the calibration process of the clamping calibration points can be automated, eliminating the need for additional components and reducing the calibration cost of clamping calibration points in the clamping mechanism.
[0005] According to a first aspect of the present disclosure, a method for calibrating a clamping calibration point in a clamping mechanism is provided, the clamping mechanism including a clamping assembly for clamping a target article placed at a preset position, the method comprising:
[0006] Control the clamping assembly to move to a first position. When the clamping assembly is in the first position, the two arms of the clamping assembly are in an open state and the target item is located between the two arms.
[0007] The clamping assembly is controlled to move from the first position along the first arm of the two arms toward the target item until the first arm contacts the target item, so as to obtain a first movement distance;
[0008] After the first arm contacts the target item, the clamping assembly is controlled to move along the second arm of the two arms toward the target item until the second arm contacts the target item, so as to obtain a second movement distance;
[0009] Based on the first position, the first movement distance, and the second movement distance, the first calibration position is obtained.
[0010] Optionally, the method further includes:
[0011] Control the clamping assembly to move to the second position. When the clamping assembly is in the second position, the two arms of the clamping assembly are in the open state and the push rod between the two arms of the clamping assembly is in contact with the end face of the target item.
[0012] Based on the second position, the second calibration position is obtained.
[0013] Optionally, the first position includes the first directional position, which is the first directional calibration position before calibration, and the first direction is the direction from the first arm to the second arm of the clamping assembly. The step of obtaining the first calibration position based on the first position, the first movement distance, and the second movement distance includes:
[0014] Obtain the first difference between the first movement distance and the second movement distance;
[0015] If the first difference meets the preset difference range, a first offset value is determined based on the first difference;
[0016] Based on the first offset value and the first direction calibration position before calibration, a first calibration position is obtained, wherein, in the first direction, the first calibration position is offset to the side with a smaller distance between the first movement distance and the second movement distance compared to the first direction calibration position before calibration.
[0017] Optionally, the method further includes:
[0018] Obtain the absolute value of the first difference between the first movement distance and the second movement distance;
[0019] If the absolute value is less than the first threshold, the first direction calibration position before calibration is determined as the first calibration position, where the first direction is the direction from the first arm to the second arm of the clamping assembly;
[0020] If the absolute value is greater than the second threshold, a prompt message indicating calibration failure is output, where the first threshold is less than the second threshold.
[0021] Optionally, the second difference between the second position including the second direction position and the second direction calibration position before calibration is obtained, wherein the second direction is the direction in which the opening formed by the two arms of the clamping assembly faces;
[0022] If the second difference meets the preset difference range, the second position including the second direction position is determined as the second calibration position.
[0023] Optionally, the clamping mechanism further includes a rotating component for rotating the direction of the clamping assembly;
[0024] Before controlling the clamping assembly to move to the first position, the method further includes:
[0025] The rotating component is controlled to drive the clamping component to rotate, so that the opening formed by the two clamping arms of the clamping component faces the direction of the target item.
[0026] Optionally, controlling the clamping assembly to move to the first position includes:
[0027] Obtain the number of times the gripping mechanism has performed a gripping task since the last calibration;
[0028] When the preset number of times is reached, the clamping component is controlled to move to the first position.
[0029] According to a second aspect of the present disclosure, a non-volatile storage medium is provided, on which a computer program is stored, which, when executed by a processor, implements the steps of the calibration method for clamping calibration points in the clamping mechanism provided in the first aspect of the present disclosure.
[0030] According to a third aspect of the present disclosure, a gripping mechanism controller is provided, comprising:
[0031] A memory on which computer programs are stored;
[0032] A processor is configured to execute the computer program in the memory to cause the gripping mechanism controller to perform the steps of the calibration method for gripping calibration points in the gripping mechanism provided in the first aspect of this disclosure.
[0033] According to a fourth aspect of the present disclosure, a clamping mechanism is provided, including a clamping component and a clamping mechanism controller provided in the third aspect of the present disclosure.
[0034] The above technical solution enables automated calibration of clamping calibration points by controlling the movement of the clamping components and simply processing the parameters obtained during the movement of the clamping components. This eliminates the need for additional components and reduces the calibration cost of clamping calibration points in the clamping mechanism.
[0035] Other features and advantages of this disclosure will be described in detail in the following detailed description section. Attached Figure Description
[0036] The accompanying drawings are provided to further illustrate the present disclosure and form part of the specification. They are used together with the following detailed description to explain the present disclosure, but do not constitute a limitation thereof. In the drawings:
[0037] Figure 1 This is a top view schematic diagram illustrating a clamping mechanism according to an exemplary embodiment.
[0038] Figure 2 This is a top view schematic diagram illustrating the working state of a clamping mechanism according to an exemplary embodiment.
[0039] Figure 3 This is a top view schematic diagram illustrating the working state of another clamping mechanism according to an exemplary embodiment.
[0040] Figure 4 This is a flowchart illustrating a calibration method for clamping calibration points in a clamping mechanism according to an exemplary embodiment.
[0041] Figure 5 This is a schematic diagram illustrating a clamping assembly located at a calibration point according to an exemplary embodiment.
[0042] Figure 6 This is a flowchart illustrating a method for calibrating the clamping calibration points of a battery in an electrical device using a clamping mechanism, according to an exemplary embodiment.
[0043] Figure 7 This is a flowchart illustrating a method for calibrating the clamping calibration points of a battery in an electrical device using a clamping mechanism, according to an exemplary embodiment.
[0044] Figure 8 This is a flowchart illustrating a method for calibrating the clamping calibration points of a battery in a charging compartment using a clamping mechanism, according to an exemplary embodiment.
[0045] Figure 9 This is a flowchart illustrating a method for calibrating the clamping calibration points of a battery in a charging compartment using a clamping mechanism, according to an exemplary embodiment.
[0046] Figure 10 This is a block diagram illustrating a gripping mechanism controller according to an exemplary embodiment. Detailed Implementation
[0047] The specific embodiments of this disclosure will be described in detail below with reference to the accompanying drawings. It should be understood that the specific embodiments described herein are for illustration and explanation only and are not intended to limit this disclosure.
[0048] It should be understood that the steps described in the method embodiments of this disclosure may be performed in different orders and / or in parallel. Furthermore, the method embodiments may include additional steps and / or omit the steps shown. The scope of this disclosure is not limited in this respect.
[0049] The term "comprising" and its variations as used herein are open-ended inclusions, meaning "including but not limited to". The term "based on" means "at least partially based on". The term "one embodiment" means "at least one embodiment"; the term "another embodiment" means "at least one additional embodiment"; the term "some implementations" means "at least some implementations". Definitions of other terms will be given in the following description.
[0050] It should be noted that the concepts of "first" and "second" mentioned in this disclosure are used only to distinguish different devices, modules or units, and are not used to limit the order of functions performed by these devices, modules or units or their interdependencies.
[0051] It should be noted that the terms "a" and "a plurality of" used in this disclosure are illustrative rather than restrictive, and those skilled in the art should understand that, unless otherwise expressly indicated in the context, they should be understood as "one or more".
[0052] Figure 1 This is a top view schematic diagram illustrating a clamping mechanism according to an exemplary embodiment, such as... Figure 1 As shown, the gripping mechanism 10 includes a gripping assembly 101 for gripping a target item 104.
[0053] Continue as Figure 1 As shown, in some embodiments, the gripping mechanism 10 may further include a drive component 102 for driving the gripping assembly 101 to move in a first direction and a second direction.
[0054] In some embodiments, the clamping mechanism 10 may further include a rotating component 103 for changing the clamping direction of the clamping assembly 101.
[0055] In some embodiments, the clamping assembly 101 may be a clamping motor, which controls the opening or closing of the clamping assembly's arms.
[0056] In some embodiments, the clamping assembly 101 may include two clamping arms and end faces connecting the two clamping arms. Optionally, both clamping arms may be straight rods or straight plates. Optionally, the two clamping arms may be two V-shaped rods or two V-shaped plates arranged facing each other.
[0057] In some embodiments, the clamping assembly 101 also includes a push rod 105 between the two arms, which is movable to contact a target object. In some examples, when the target object is a drone battery, the push rod can be used to press the drone's power button to turn the drone on or off.
[0058] In some embodiments, the drive assembly 102 may include a first drive motor for driving the clamping assembly to move in a first direction and a second drive motor for driving the clamping assembly to move in a second direction.
[0059] In some implementations, the rotating component 103 may be a rotating motor.
[0060] In some embodiments, the first direction can be the direction from the first arm to the second arm of the clamping assembly, and the second direction can be the direction facing the opening formed by the two arms of the clamping assembly. The first and second directions can be perpendicular to each other. In this definition, combined with... Figure 2 as well as Figure 3 The exemplary application scenario shown illustrates the working state of the gripping mechanism in the embodiments of this disclosure.
[0061] Figure 2 This is a top view schematic diagram of a clamping mechanism in operation. Figure 2 In the example shown, the electrical device 201 (such as a drone, a new energy vehicle, etc.) can be parked at a designated location, and the clamping mechanism 202 can clamp the battery located in the charging compartment 203 to the designated location to facilitate battery replacement for the electrical device, and clamp the battery of the electrical device 201 from the designated location to the charging compartment 203 to facilitate battery charging.
[0062] exist Figure 2 In the example shown, the first drive motor 2021 can drive the clamping assembly to move along the direction from the first arm to the second arm, for example... Figure 2 In the Y-axis direction, the second drive motor 2022 drives the clamping assembly to move along the direction directly opposite the opening formed by the two clamping arms, for example... Figure 2 The X-axis direction in the equation. Furthermore, in... Figure 2 In the middle, the left side of the gripping mechanism 202 is set to the +Y direction, and the top of the gripping mechanism 202 is set to the +X direction.
[0063] Figure 3 This is a top view schematic diagram of another clamping mechanism in operation. Figure 3 In the example shown, compared to Figure 2 In the working state, the positions of the charging compartment 203 and the electrical equipment 201 remain unchanged, while the clamping direction of the clamping mechanism 202 rotates.
[0064] In this case, Figure 3 In the example shown, the first drive motor 2021 drives the clamping assembly to move along the direction from the first arm to the second arm, for example... Figure 3 In the X-axis direction, the second drive motor 2022 drives the clamping assembly to move along the direction directly opposite the opening formed by the two clamping arms, for example... Figure 2The Y-axis direction in the middle. Furthermore, in... Figure 3 In the middle, the left side of the gripping mechanism 202 is set to the +Y direction, and the top of the gripping mechanism 202 is set to the +X direction.
[0065] It should be noted that, Figures 1-3 The structure of the gripping mechanism shown is only one example; in some embodiments, the gripping mechanism may include a larger... Figure 1 or Figure 2 The structure shown can be further expanded, or parts of the structure can be replaced without affecting the corresponding function. For example, in Figures 1-3 It can also include a pallet motor ( Figures 1-3 (Not shown in the image) is used to support and hold the items being clamped, preventing them from falling due to excessive weight.
[0066] exist Figure 2 as well as Figure 3 In the application scenario shown, the battery in the electrical equipment 201 and the battery in the charging compartment 203 can be regarded as target items respectively.
[0067] Figure 4 This is a flowchart illustrating a calibration method for a clamping calibration point in a clamping mechanism according to an exemplary embodiment. The method can be applied to a clamping mechanism controller. The clamping mechanism includes a clamping component for clamping a target item placed in a preset position, such as... Figure 4 As shown, the method may include the following steps:
[0068] In step S401, the clamping assembly is controlled to move to a first position. When the clamping assembly is in the first position, the two arms of the clamping assembly are in an open state and the target item is located between the two arms.
[0069] In some implementations, the clamping assembly can be driven to a first position by the drive mechanism described in the foregoing embodiments.
[0070] In some implementations, to facilitate placing the target item between the two arms, the gripping mechanism controller can first control the gripping assembly to fully open the two arms, and then control the gripping assembly to move to a first position.
[0071] In some implementations, the first position can be represented by two position coordinates: a first direction position and a second direction position. The first direction is the direction from the first arm to the second arm of the clamping assembly, and the second direction is the direction in which the opening formed by the two arms of the clamping assembly faces.
[0072] The first position, including the first directional position, can have several possibilities. Optionally, the first directional position included in the first position can be the first directional calibration position before calibration, or it can be any position that satisfies the condition that the target item is located between the two arms.
[0073] As can be seen from the foregoing, before executing the calibration method of this embodiment, the clamping mechanism has a corresponding calibration point. This calibration point can be understood as the calibration position before calibration. The calibration position before calibration may also include the position in the first direction, i.e., the first direction calibration position before calibration, and the position in the second direction, i.e., the second direction calibration position before calibration.
[0074] In some implementations, the clamping component can be controlled to move in a first direction and a second direction so that the clamping component moves to a first position.
[0075] In step S402, the clamping assembly is controlled to move from the first position along the first arm of the two arms toward the target item until the first arm contacts the target item, so as to obtain a first movement distance.
[0076] In step S403, after the first arm contacts the target item, the clamping assembly is controlled to move along the second arm of the two arms toward the target item until the second arm contacts the target item, so as to obtain a second movement distance.
[0077] In this embodiment of the present disclosure, after the gripping component is moved to the first position, the gripping mechanism controller can continue to control the gripping component to move back and forth along the first direction and contact the target item, so as to obtain the movement distance of the two movements.
[0078] Specifically, in this embodiment of the present disclosure, the gripping mechanism controller controls the gripping component to start moving from the first position. The direction of movement is along the first arm of the two arms toward the target item. After the gripping component moves to the point where the first arm contacts the target item, the movement distance during this movement can be obtained, i.e., the first movement distance.
[0079] Next, after the first arm contacts the target item, the gripping mechanism controller continues to control the gripping assembly to move in the opposite direction from the contact position, that is, to move along the second arm of the two arms toward the target item. After the second arm contacts the target item, the movement distance during this movement can be obtained, that is, the second movement distance.
[0080] As can be seen from the foregoing, in some embodiments, the clamping assembly can be driven by a drive motor. In this case, after the first arm contacts the target item and generates a stall current, the first movement distance is recorded. Similarly, after the second arm contacts the target item and generates a stall current, the first movement distance is recorded.
[0081] It should be noted that in this embodiment of the present disclosure, the first arm can clamp any one of the clamping arms of the component, and after the first arm is selected, the other clamping arm in the component is the second arm.
[0082] For example, please refer to Figure 5 For example, after the right gripping arm is identified as the first arm, the gripping arm located on the left side is the second arm. In this case, the gripping mechanism controller controls the gripping assembly to move along the first arm of the two arms toward the target item. This can be done by controlling the gripping assembly to move in the +Y direction. As it continues to move in the +Y direction until the first arm contacts the target item, the gripping assembly can be controlled to stop moving, and the first movement distance L1 can be recorded.
[0083] Next, the gripping mechanism controller controls the gripping assembly to move along the second arm of the double arms toward the target item. This can be done by controlling the gripping assembly to move in the -Y direction. As it continues to move in the -Y direction until the second arm contacts the target item, the gripping assembly can be controlled to stop moving, and the second movement distance L2 can be recorded.
[0084] In step S403, a first calibration position is obtained based on the first position, the first movement distance, and the second movement distance.
[0085] In this embodiment of the disclosure, after the first position, the first movement distance, and the second movement distance, the first calibration position can be obtained based on the first position, the first movement distance, and the second movement distance.
[0086] The first calibration position can be understood as the calibration position in the direction from the first arm to the second arm of the clamping assembly (i.e., the first direction).
[0087] In some embodiments, the calibration of the clamping calibration point in the clamping mechanism may further include calibration in the direction (i.e., the second direction) directly opposite the opening formed by the two arms of the clamping assembly. Therefore, the calibration position may further include a second calibration position. In this case, the method of the present disclosure embodiment may further include the following steps:
[0088] The clamping assembly is controlled to move to a second position. When the clamping assembly is in the second position, the two arms of the clamping assembly are in an open state and the push rod between the two arms of the clamping assembly is in contact with the end face of the target item. Based on the second position, a second calibration position is obtained.
[0089] In this embodiment of the present disclosure, the gripping mechanism controller can control the movement of the gripping component. After the target item is located between the two arms, the gripping component can continue to be controlled to move in the second direction until the top rod between the two arms contacts the end face of the target item, thus determining that the gripping component has moved to the second position. Then, based on the second position, the second calibration position can be obtained.
[0090] It should be noted that, in this embodiment of the present disclosure, the order in which the clamping component moves to the first position and the clamping component moves to the second position is not limited.
[0091] In some implementations, the first and second calibration positions can be determined as the clamping calibration points of the clamping component for the target item. Subsequently, the gripping mechanism controller can control the clamping component to move to the calibrated clamping calibration points, thereby ensuring the success of the task when performing the operation on the target item.
[0092] Using the method of this embodiment, the clamping assembly is controlled to move so that the arms of the clamping assembly are in an open state and the target item is located between the arms. Then, the clamping assembly is controlled to move from the first position along the first arm of the arms toward the target item until the first arm contacts the target item to obtain a first movement distance. Then, after the first arm contacts the target item, the clamping assembly is controlled to move along the second arm of the arms toward the target item until the second arm contacts the target item to obtain a second movement distance. Then, a first calibration position can be obtained based on the first position, the first movement distance, and the second movement distance.
[0093] It is evident that, within the existing working capacity of the clamping mechanism, by controlling the movement of the clamping components and simply processing the parameters obtained during the movement of the clamping components, the automated calibration process of the clamping calibration points can be achieved, eliminating the need for additional components and reducing the calibration cost of the clamping calibration points in the clamping mechanism.
[0094] As can be seen from the foregoing, in some embodiments, the first position includes the first directional position, which is the first directional calibration position before calibration. The first direction is the direction from the first arm to the second arm of the clamping assembly. In this case, obtaining the first calibration position based on the first position, the first movement distance, and the second movement distance may include the following steps:
[0095] Obtain a first difference between the first interval and the second interval; if the first difference meets a preset difference range, determine a first offset value based on the first difference; based on the first offset value and the first direction calibration position before calibration, obtain a first calibration position, wherein, in the first direction, the first calibration position is offset to the side with a smaller distance between the first movement distance and the second movement distance compared to the first direction calibration position before calibration.
[0096] In some implementations, obtaining the first difference between the first movement distance and the second movement distance can be achieved by subtracting the second movement distance from the first movement distance. In this case, the first difference can be a positive value, i.e., the first movement distance is greater than the second movement distance, or it can be a negative value, i.e., the first movement distance is less than the second movement distance. Therefore, the preset difference range can include a positive value range and a negative value range.
[0097] In some implementations, determining the first offset value based on the first difference may involve obtaining the absolute value of the first difference and then determining half of the obtained absolute value as the first offset value.
[0098] In this embodiment of the present disclosure, after determining the first offset value, the first directional calibration position before calibration can be shifted to the side with the smaller distance between the first movement distance and the second movement distance by the first offset value to obtain the first calibration position.
[0099] For example, continue to refer to Figure 5 Assuming the first direction calibration position before calibration is coordinate y0, and the first movement distance L1 is greater than the second movement distance L2, then the first offset value is |L1-L2| / 2, and the first direction calibration position after calibration is y1=y0+|L1-L2| / 2.
[0100] In some implementations, obtaining the first difference between the first movement distance and the second movement distance can be the difference between the larger and smaller values of the two. In this case, the first difference is positive, and the preset difference range can be a positive range. In this case, half of the first difference can be directly determined as the first offset value. Furthermore, the first calibration position before calibration can be shifted to the side with the smaller distance between the first movement distance and the second movement distance by the position of the first offset value to obtain the first calibration position.
[0101] Considering that when the aging of the clamping component is small, the offset of the calibration point within a small range will not affect the clamping mechanism's task execution. For example, it can still work normally when the difference between the first and second movement distances is within 0.05mm. In addition, considering that the aging of the clamping component is limited within a limited time, the calibration point is unlikely to shift by a large range under normal circumstances. For example, when performing 20 clamping tasks, the difference between the first and second movement distances is unlikely to be greater than 2mm.
[0102] Therefore, in some implementations, when the preset difference range includes both positive and negative intervals, the negative interval can be (-c, -d), and the positive interval can be (d, c), where c > d. When the preset difference range is a positive interval, the positive interval can be (d, c).
[0103] In one example, c can be 2mm and d can be 0.05mm.
[0104] In some implementations, the method of this disclosure may further include the following steps:
[0105] Obtain the absolute value of the first difference between the first movement distance and the second movement distance; if the absolute value is less than the first threshold, determine the first calibration position in the first direction before calibration as the first calibration position; if the absolute value is greater than the second threshold, output a prompt message indicating calibration failure, where the first threshold is less than the second threshold.
[0106] In this embodiment of the disclosure, when the absolute value of the first difference between the first movement distance and the second movement distance is less than the first threshold, it indicates that the degree of motion aging of the clamping component is small. In this case, the clamping calibration point does not need to be modified, so that the first direction calibration position before calibration can be determined as the first calibration position.
[0107] When the absolute value of the first difference between the first movement distance and the second movement distance is greater than the second threshold, it indicates that the absolute value of the first difference exceeds the finite time. The interval difference may be caused by the aging degree of the clamping component movement, which may be a point error. In this case, a prompt message indicating calibration failure can be output.
[0108] For example, the first threshold can be 0.05 mm and the second threshold can be 2 mm.
[0109] As can be seen from the foregoing, in some other embodiments, the first position, including the first directional position, can also be any position that satisfies the condition that the target item is located between the arms. In this case, obtaining the first calibration position based on the first position, the first movement distance, and the second movement distance may include the following steps:
[0110] The first calibration position is obtained based on the first calibration position in the first direction before calibration, the first position, the first movement distance, and the second movement distance.
[0111] In this embodiment of the disclosure, considering that the first position may itself deviate from the first direction calibration position before calibration, the first offset value cannot be determined directly based on the first difference. Instead, it is necessary to consider the magnitude of the deviation between the first direction position itself and the first direction position before calibration. Therefore, in this case, the first calibration position can be obtained based on the first direction calibration position before calibration, the first position, the first movement distance, and the second movement distance.
[0112] For example, the absolute value of the first difference between the first movement distance and the second movement distance can be obtained, and the absolute value can be subtracted by twice the distance between the first direction position included in the first position and the first direction calibration position before calibration. The obtained value is then compared with a preset difference range, and if the preset difference range is met, the first offset value can be further determined based on the obtained value.
[0113] In some implementations, obtaining the second calibration position based on the second position may include the following steps:
[0114] Obtain the second difference between the second position including the second direction position and the second direction calibration position before calibration; if the second difference meets the preset difference range, determine the second direction position including the second position as the second calibration position.
[0115] In this embodiment of the disclosure, the second position can also be represented by the position coordinates of the first direction position and the second direction position.
[0116] Similarly, when the second difference can be positive or negative, the preset difference range can include both positive and negative intervals. When the second difference is positive, the preset difference range can include a positive interval.
[0117] In this embodiment of the disclosure, when the second difference meets a preset difference range, the second directional position included in the second position can be determined as the second calibration position. When the absolute value of the second difference is greater than a second threshold, a prompt message indicating calibration failure can be output. When the absolute value of the second difference is less than a first threshold, the second directional calibration position before calibration is determined as the second calibration position.
[0118] In some implementations, the second directional position included in the second position can also be directly determined as the second calibration position.
[0119] In some implementations, controlling the clamping assembly to move to the first position may include the following steps:
[0120] The number of times the gripping mechanism has performed a gripping task since the last calibration is obtained; when the number of times reaches a preset number, the gripping component is controlled to move to the first position.
[0121] To ensure the timeliness of the calibration method, the clamping mechanism can be set to automatically execute the calibration method of this embodiment after performing a preset number of clamping tasks. Therefore, in this embodiment, the clamping mechanism controller can obtain the number of times the clamping mechanism has performed clamping tasks since the last calibration. When the number of times the clamping task has been performed since the last calibration reaches a preset number, such as 20 times, the clamping component can be controlled to move to the first position and the calibration method of this embodiment can be executed.
[0122] It should be noted that the preset difference range, the first threshold, and the second threshold can be set according to the actual gripping task, for example, based on the degree of wear caused by the gripped object, the number of times the calibration method is executed, etc. Furthermore, they can also be determined based on the first position, including the first directional position.
[0123] As can be seen from the foregoing, in some embodiments, the clamping mechanism further includes a rotating component for rotating the direction of the clamping assembly. In this case, before controlling the clamping assembly to move to the first position, the method of this disclosure embodiment may further include the following steps:
[0124] The control rotation component drives the clamping component to rotate, so that the opening formed by the two clamping arms of the clamping component faces the direction of the target item.
[0125] In this embodiment of the present disclosure, in order to improve the accuracy of calibration, the rotating component can be controlled to drive the clamping component to rotate so that the opening direction formed by the two clamping arms of the clamping component faces the direction of the target item, and then the clamping component can be controlled to move to the first position.
[0126] For example, continue to use Figure 2 as well as Figure 3 For example, assuming the clamping assembly was previously used to calibrate the clamping calibration points of the battery in the charging compartment, in order to continue calibrating the clamping calibration points of the battery in the device, the rotating assembly can be controlled to drive the clamping assembly to rotate so that the opening direction (i.e., the second direction) formed by the two clamping arms of the clamping assembly is towards the direction where the battery in the device is located, i.e., the +X direction, and then the clamping assembly can be controlled to move to the first position.
[0127] Alternatively, assuming that the clamping assembly was previously used to calibrate the clamping calibration points of the battery in the electrical device, in order to continue calibrating the clamping calibration points of the battery in the charging compartment, the rotating assembly can be controlled to drive the clamping assembly to rotate so that the opening direction (i.e., the second direction) formed by the two clamping arms of the clamping assembly is towards the direction where the battery is located in the charging compartment, i.e., the +Y direction, and then the clamping assembly can be controlled to move to the first position.
[0128] The method of the embodiments of this disclosure will now be described in detail with a complete process.
[0129] After the gripping mechanism completes one battery replacement for the electrical equipment, obtain the number of times the gripping mechanism has performed the battery replacement task since the last calibration.
[0130] Determine if the number of attempts exceeds the preset number of attempts;
[0131] If the number of cycles exceeds the preset limit, the gripping mechanism controller will execute the calibration process of the clamping calibration point in the gripping mechanism; otherwise, calibration is not required, and the gripping mechanism can continue to perform the function of changing the battery for the electrical equipment.
[0132] The calibration method process for the clamping calibration points in the clamping mechanism, executed by the clamping mechanism controller, may include executing the calibration method process for the clamping calibration points corresponding to the batteries in the charging compartment, and executing the calibration method process for the clamping calibration points corresponding to the batteries in the electrical equipment.
[0133] refer to Figure 6 as well as Figure 7 The diagram shown is as follows. Figure 6 A method for a clamping mechanism to clamp a battery in an electrical device, including a first calibration position. Figure 7 A method for a clamping mechanism to include a second calibration position for clamping calibration points of batteries in electrical equipment.
[0134] like Figure 6 As shown, the method may include the following steps:
[0135] In step S601, the rotating assembly is controlled to drive the clamping assembly to rotate, so that the second direction faces the direction where the battery in the electric device is located.
[0136] Herein, the second direction is the direction directly facing the opening formed by the two arms of the clamping assembly.
[0137] In step S602, the clamping assembly is controlled to fully open the clamping arms.
[0138] In step S603, the first drive motor is controlled to drive the clamping assembly to move along the first direction to the pre-calibration first direction calibration position.
[0139] Herein, the first direction is the direction from the first arm to the second arm of the clamping assembly.
[0140] In step S604, the second drive motor is controlled to drive the clamping assembly to move along the second direction to the pre-calibration second direction calibration position.
[0141] In step S605, the first drive motor is controlled to drive the clamping assembly to move in the +Y direction until the clamping arm touches one side of the battery in the electric device and stops (relying on locked-rotor current), the moving distance is recorded, assuming this distance is a, then the first movement distance L1 = a.
[0142] In step S606, the first drive motor is controlled to drive the clamping assembly to move in the -Y direction until the clamping arm touches the other side of the battery in the electric device and stops (relying on locked-rotor current), the moving distance is recorded, assuming this distance is b, so that the second movement distance is obtained as L2 = b-a.
[0143] In step S607, it is determined whether the first movement distance L2 is greater than the second movement distance L1, that is, whether b-a is greater than a.
[0144] In step S608, if b-a > a and d < (b-a)-a < c, the first calibration position y1 included in the clamping calibration point of the clamping assembly for the battery in the electric device is calculated by the following formula:
[0145] y1 = y0 - [(b-a)-a] / 2.
[0146] In step S609, if a > b-a and d < (a-b)-a < c, the first calibration position y1 included in the clamping calibration point of the clamping assembly for the battery in the electric device is calculated by the following formula:
[0147] y1 = y0 + [(a-b)-a] / 2.
[0148] In some implementations, the Y-value of the battery clamping position in the electrical device is consistent with the Y-axis value of the power-on point of the electrical device. Therefore, the first calibration position corresponding to the power-on point of the electrical device can also be y1 as described above.
[0149] In some implementations, after obtaining the first calibration position y1 of the clamping calibration point for the battery in the device, the value of y1 can be rewritten into the MCU (Microcontroller Unit) through a calibration protocol, so that the subsequent clamping mechanism controller can control the first drive motor to drive the clamping component to move to the calibrated clamping calibration point according to the value corresponding to y1, so as to clamp the battery in the device.
[0150] like Figure 7 As shown, the method may include the following steps:
[0151] In step S701, the rotating component is controlled to drive the clamping component to rotate, so that the second direction is toward the direction where the battery in the electrical device is located.
[0152] In step S702, the clamping assembly is controlled to fully open the clamping arm.
[0153] In step S703, the first drive motor is controlled to drive the clamping assembly to move along the first direction to the first direction calibration position before calibration.
[0154] In step S704, the second drive motor is controlled to drive the clamping assembly to move along the second direction until the push rod between the two arms of the clamping assembly contacts the battery in the electrical equipment and stops (due to stall current), and the position in the second direction at this time is recorded.
[0155] In step S705, if the second difference between the second directional position and the second directional calibration position before calibration meets the preset difference range, then the second directional position is determined as the second calibration position x1 included in the clamping calibration point of the clamping component for the battery in the electrical device.
[0156] In some implementations, the battery clamping position X value in the electrical device is consistent with the value of the power-on point position of the electrical device on the X-axis. In this case, the second calibration position corresponding to the power-on point of the electrical device can also be the same as the above x1.
[0157] In some implementations, after obtaining the second calibration position x1 of the clamping calibration point for the battery in the device, the value of x1 can be rewritten into the MCU through a calibration protocol, so that the subsequent clamping mechanism controller can control the second drive motor to drive the clamping component to move to the calibrated clamping calibration point according to the value corresponding to x1, so as to clamp the battery in the device.
[0158] In some implementations, after the values of x1 and y1 are rewritten into the MCU through a calibration protocol, a battery clamping function in the electrical device can be executed once. If successful, the calibration is completed; otherwise, the first calibration position and the second calibration position before calibration are restored to the MCU.
[0159] Through the above process, the calibration method for the clamping calibration point corresponding to the battery in the electrical equipment is completed by the clamping mechanism controller. Subsequently, the calibration method for the clamping calibration point corresponding to the battery in the charging compartment can be further executed.
[0160] refer to Figure 8 as well as Figure 9 The diagram shown is as follows. Figure 8 A method for a clamping mechanism to clamp the battery in the charging compartment, including a first calibration position. Figure 9 A method for a second calibration position including the clamping calibration point of the clamping mechanism for the battery in the charging compartment.
[0161] like Figure 8 As shown, the method may include the following steps:
[0162] In step S801, the rotating component is controlled to drive the clamping component to rotate, so that the second direction is toward the direction where the battery is located in the charging compartment.
[0163] In step S802, the clamping assembly is controlled to fully open the clamping arm.
[0164] In step S803, the first drive motor is controlled to drive the clamping assembly to move along the first direction to the first direction calibration position before calibration.
[0165] In step S804, the second drive motor is controlled to drive the clamping assembly to move along the second direction to the second direction calibration position before calibration.
[0166] In step S805, the first drive motor is controlled to drive the clamping assembly to move in the +X direction until the clamping arm touches one side of the battery in the charging compartment and stops (by the stall current). The distance moved is recorded, and this distance is assumed to be a. Then the first movement distance L1 = a.
[0167] In step S806, the first drive motor is controlled to drive the clamping assembly to move in the -X direction until the clamping arm touches the other side of the battery in the charging compartment and stops (by the stall current). The distance moved is recorded, which is assumed to be b. Thus, the second movement distance can be obtained as L2 = ba.
[0168] In step S807, it is determined whether the first movement distance L2 is greater than the second movement distance L1, that is, whether ba is greater than a.
[0169] In step S808, if b-a>a, and d<(b-a)-a<c, the first calibration position x1 included in the gripping calibration point of the clamping assembly for the battery in the charging compartment is calculated by the following formula:
[0170] x1=x0-[(b-a)-a] / 2.
[0171] In step S809, if a>b-a, and d<(a-b)-a<c, the first calibration position x1 included in the gripping calibration point of the clamping assembly for the battery in the electric device is calculated by the following formula:
[0172] x1=x0+[(a-b)-a] / 2.
[0173] In some implementations, after obtaining the first calibration position x1 included in the gripping calibration point of the clamping assembly for the battery in the charging compartment, the value of x1 can be rewritten into the MCU through a calibration protocol, so that the subsequent gripper controller can control the first drive motor to drive the clamping assembly to move to the calibrated gripping calibration point according to the value corresponding to x1, so as to grip the battery in the charging compartment.
[0174] As Figure 9 shown, the method may include the following steps:
[0175] In step S901, the rotating assembly is controlled to drive the clamping assembly to rotate, so that the second direction faces the direction where the battery in the charging compartment is located.
[0176] In step S902, the clamping assembly is controlled to fully open the clamping arms.
[0177] In step S903, the first drive motor is controlled to drive the clamping assembly to move along the first direction to the pre-calibration first direction calibration position.
[0178] In step S904, the second drive motor is controlled to drive the clamping assembly to move along the second direction until the ejector rod comes into contact with the battery in the charging compartment and stops (relying on stall current), and the current second direction position is recorded.
[0179] In step S905, if the second difference between the second direction position and the pre-calibration second direction calibration position meets the preset difference range, the second direction position is determined as the second calibration position y1 included in the gripping calibration point of the clamping assembly for the battery in the charging compartment.
[0180] In some implementations, after obtaining the second calibration position y1 of the clamping calibration point of the clamping component for the battery in the charging compartment, the value of y1 can be rewritten into the MCU through a calibration protocol, so that the subsequent clamping mechanism controller can control the second drive motor to drive the clamping component to move to the calibrated clamping calibration point according to the value corresponding to y1, so as to clamp the battery in the charging compartment.
[0181] In some implementations, after the values of x1 and y1 are rewritten into the MCU via a calibration protocol, a battery clamping function in the charging compartment can be performed once. If successful, the calibration is completed; otherwise, the first calibration position and the second calibration position before calibration are restored to the MCU.
[0182] The above process completes the calibration method for the clamping calibration points corresponding to the electrical equipment and the battery in the charging compartment in the clamping mechanism, which is executed by the clamping mechanism controller.
[0183] Figure 10 This is a block diagram illustrating a gripping mechanism controller according to an exemplary embodiment. (Refer to...) Figure 10 The gripping mechanism controller 1000 includes a processor 1022, which may be one or more, and a memory 1032 for storing computer programs executable by the processor 1022. The computer program stored in the memory 1032 may include one or more modules, each corresponding to a set of instructions. Furthermore, the processor 1022 may be configured to execute the computer program to perform the calibration method for the gripping calibration points in the gripping mechanism described above.
[0184] Additionally, the gripping mechanism controller 1000 may also include a power supply component 1026 and a communication component 1050. The power supply component 1026 may be configured to perform power management of the gripping mechanism controller 1000, and the communication component 1050 may be configured to enable communication of the gripping mechanism controller 1000, such as wired or wireless communication. Furthermore, the gripping mechanism controller 1000 may also include an input / output interface 1058.
[0185] In another exemplary embodiment, a clamping mechanism is also provided, including a clamping mechanism and a clamping mechanism controller as described in the above embodiments.
[0186] In another exemplary embodiment, a non-volatile storage medium including program instructions is also provided. When executed by a processor, these program instructions implement the steps of the calibration method for the clamping calibration points in the clamping mechanism described above. For example, the non-volatile storage medium may be the memory 1032 including the program instructions described above. These program instructions may be executed by the processor 1022 of the clamping mechanism controller 1000 to complete the calibration method for the clamping calibration points in the clamping mechanism described above.
[0187] In another exemplary embodiment, a computer program product is also provided, the computer program product comprising a computer program executable by a programmable device, the computer program having a code portion for performing the calibration method for clamping calibration points in the clamping mechanism as described above when executed by the programmable device.
[0188] The preferred embodiments of this disclosure have been described in detail above with reference to the accompanying drawings. However, this disclosure is not limited to the specific details of the above embodiments. Within the scope of the technical concept of this disclosure, various simple modifications can be made to the technical solutions of this disclosure, and these simple modifications all fall within the protection scope of this disclosure.
[0189] It should also be noted that the various specific technical features described in the above embodiments can be combined in any suitable manner without contradiction. To avoid unnecessary repetition, this disclosure will not describe the various possible combinations separately.
[0190] Furthermore, various different embodiments of this disclosure can be combined in any way, as long as they do not violate the spirit of this disclosure, they should also be regarded as the content disclosed in this disclosure.
Claims
1. A method for calibrating clamping calibration points in a clamping mechanism, characterized in that, The clamping mechanism includes a clamping component for clamping a target item placed at a preset position, and the method includes: Control the clamping assembly to move to a first position. When the clamping assembly is in the first position, the two arms of the clamping assembly are in an open state and the target item is located between the two arms. The clamping assembly is controlled to move from the first position along the first arm of the two arms toward the target item until the first arm contacts the target item, so as to obtain a first movement distance; After the first arm contacts the target item, the clamping assembly is controlled to move along the second arm of the two arms toward the target item until the second arm contacts the target item, so as to obtain a second movement distance; Based on the first position, the first movement distance, and the second movement distance, the first calibration position is obtained; Wherein, the first position includes the first directional position, which is the first directional calibration position before calibration, and the first direction is the direction from the first arm to the second arm of the clamping assembly. The step of obtaining the first calibration position based on the first position, the first movement distance, and the second movement distance includes: Obtain the first difference between the first movement distance and the second movement distance; If the first difference meets the preset difference range, a first offset value is determined based on the first difference; Based on the first offset value and the first direction calibration position before calibration, a first calibration position is obtained, wherein, in the first direction, the first calibration position is offset to the side with a smaller distance between the first movement distance and the second movement distance compared to the first direction calibration position before calibration.
2. The method according to claim 1, characterized in that, The method further includes: Control the clamping assembly to move to the second position. When the clamping assembly is in the second position, the two arms of the clamping assembly are in the open state and the push rod between the two arms of the clamping assembly is in contact with the end face of the target item. Based on the second position, the second calibration position is obtained.
3. The method according to claim 1, characterized in that, The method further includes: Obtain the absolute value of the first difference between the first movement distance and the second movement distance; If the absolute value is less than the first threshold, the first direction calibration position before calibration is determined as the first calibration position, where the first direction is the direction from the first arm to the second arm of the clamping assembly; If the absolute value is greater than the second threshold, a prompt message indicating calibration failure is output, where the first threshold is less than the second threshold.
4. The method according to claim 2, characterized in that, The process of obtaining the second calibration position based on the second position includes: The second position includes the second direction position and the second difference between the second direction calibration position before calibration, wherein the second direction is the direction in which the opening formed by the two arms of the clamping assembly faces; If the second difference meets the preset difference range, the second position including the second direction position is determined as the second calibration position.
5. The method according to claim 1, characterized in that, The clamping mechanism further includes a rotating component for rotating the direction of the clamping assembly; Before controlling the clamping assembly to move to the first position, the method further includes: The rotating component is controlled to drive the clamping component to rotate, so that the opening formed by the two clamping arms of the clamping component faces the direction of the target item.
6. The method according to any one of claims 1-5, characterized in that, The control of the clamping assembly to move to the first position includes: Obtain the number of times the gripping mechanism has performed a gripping task since the last calibration; When the preset number of times is reached, the clamping component is controlled to move to the first position.
7. A non-volatile storage medium having a computer program stored thereon, characterized in that, When executed by the processor, the program implements the steps of the calibration method for clamping calibration points in the clamping mechanism as described in any one of claims 1-6.
8. A gripping mechanism controller, characterized in that, include: A memory on which computer programs are stored; A processor is configured to execute the computer program in the memory to cause the gripping mechanism to perform the steps of the calibration method for gripping calibration points in any one of claims 1-6.
9. A clamping mechanism, characterized in that, It includes a clamping assembly and a clamping mechanism controller as described in claim 8.
Citation Information
Patent Citations
Article grabbing planning method and system
CN114102585A
Control method of mechanical arm and related product
CN115488875A
