Robot, storage medium, vehicle and method for robot to avoid singular points
By adjusting the connection angle between the flange and the grabber, the singular points that appear during the movement of the robot are avoided, and the problem of robots losing their freedom and alarms near the singular points in the prior art is solved, ensuring the photovoltaic panel paving task The successful completion.
Patent Information
- Application Number
- CN202411067175.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-06
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2044-08-06
AI Technical Summary
Existing robots may pass through singular points when performing actions, resulting in loss of freedom and rapid increase in rotation speed, and will not be able to move, especially when grabbing and laying photovoltaic panels, they will be called.
By adjusting the connection angle between the flange and the grab member, change the transfer matrix MF of the last connecting shaft and the flange at one end, so that the rotation angle of the last connecting shaft and the subsequent last connecting shaft is always greater than 0°, avoiding singularity point.
It effectively avoids the robot's singularity during movement, ensures that the robot can successfully complete the paving task of photovoltaic panels, and prevents rapid speed increase and alarm.
Smart Images

Figure CN118927227A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of robotics technology, and in particular to a robot, a storage medium, a vehicle, and a method for the robot to avoid singularities. Background Art
[0002] Existing robots may pass through singular points during the execution of actions. When the robot passes near a singular point, it will sound an alarm or even have difficulty moving.
[0003] When using a robot to grab and lay photovoltaic panels, the robot grabs the photovoltaic panels at one location and then lays the photovoltaic panels at another location. During this movement, if the axis of the robot's fourth axis is parallel to the axis of the sixth axis, the robot moves to a singularity point and loses one degree of freedom. The robot cannot move and the rotation speed of the robot's fourth axis will rise rapidly, causing an alarm. Summary of the invention
[0004] The present application provides a robot, a storage medium, a vehicle and a method for the robot to avoid singularity points.
[0005] In a first aspect, the present application provides a robot for paving a photovoltaic panel to a set position at a preset inclination angle, the robot comprising:
[0006] The mechanical arm has a plurality of connecting shafts connected in sequence, and two adjacent connecting shafts are rotationally connected;
[0007] A flange connected to the last connecting shaft among the plurality of connecting shafts;
[0008] A gripping member connected to the flange, the gripping member being used to grip and release the photovoltaic panel;
[0009] A controller, electrically connected to the robotic arm;
[0010] Among them, the controller is used to determine the transfer matrix MP of the center point of the photovoltaic panel set at the set position according to the inclination angle when the photovoltaic panel is paved at the set position and the height from the ground when the photovoltaic panel is paved at the set position; the controller is also used to determine the relative rotation angle between the next-to-last connecting axis and the next-to-last connecting axis according to the transfer matrix MP, the shape and size parameters of the flange, the connection angle between the flange and the grabbing member, and the shape and size parameters of the grabbing member; the controller is used to control the connection angle between the flange and the grabbing member to control the relative rotation angle between the next-to-last connecting axis and the next-to-last connecting axis, so that the relative rotation angle between the next-to-last connecting axis and the next-to-last connecting axis is always greater than 0°.
[0011] In combination with the first aspect, in a possible implementation, the relative rotation angle between the second-to-last connecting shaft and the second-to-last connecting shaft is always greater than a set threshold, and the set threshold is greater than or equal to 0° and less than or equal to 5°.
[0012] In combination with the first aspect, in a possible implementation manner, a connection angle between the flange and the grabbing member is 10° to 45°.
[0013] In combination with the first aspect, in a possible implementation, the flange includes a first end face and a second end face arranged opposite to each other, the first end face is connected to the last connecting shaft among a plurality of connecting shafts, the second end face is connected to a grabbing member, and the first end face and the second end face form an angle greater than 0° and less than 45°.
[0014] In combination with the first aspect, in a possible implementation, the robot further includes a driving member, which is used to drive the grasping member to control a pitch angle of the grasping member relative to the flange to control a connection angle between the grasping member and the flange.
[0015] In a second aspect, the present application provides a method for a robot to avoid singularity points, the method being applied to the robot as in the first aspect, the method comprising:
[0016] Determine the transfer matrix MP of the center point of the photovoltaic panel at the set position according to the inclination angle of the photovoltaic panel when it is paved at the set position, the height of the photovoltaic panel from the ground when it is paved at the set position, and the set position;
[0017] Determine the relative rotation angle between the next last connection axis and the next next last connection axis according to the transfer matrix MP, the shape and size parameters of the flange, the connection angle between the flange and the grabbing member, and the shape and size parameters of the grabbing member;
[0018] The connection angle between the flange and the grabbing member is adjusted to adjust the relative rotation angle between the second last connecting shaft and the second last connecting shaft, so that the relative rotation angle between the second last connecting shaft and the second last connecting shaft is always greater than 0°.
[0019] In combination with the second aspect, in a possible implementation manner, determining the relative rotation angle between the next-to-last connection axis and the next-to-last connection axis according to the transfer matrix MP, the shape and size parameters of the flange, the connection angle between the flange and the grabbing member, and the shape and size parameters of the grabbing member includes:
[0020] According to the transfer matrix MP, the shape and size parameters of the grabbing member, and the connection angle between the flange and the grabbing member, a transfer matrix ME of the end of the flange connected to the grabbing member is obtained;
[0021] Determine the transfer matrix MF of the end of the last connecting shaft among the multiple connecting shafts connected to the flange according to the transfer matrix ME, the shape and size parameters of the flange, and the connection angle between the flange and the grabbing member;
[0022] The relative rotation angle between the second-to-last connecting axis and the second-to-last connecting axis is determined based on the transfer matrix MF.
[0023] In combination with the second aspect, in a possible implementation manner, adjusting the connection angle between the flange and the grabbing member to adjust the relative rotation angle between the next-to-last connecting shaft and the next-to-last connecting shaft so that the relative rotation angle between the next-to-last connecting shaft and the next-to-last connecting shaft is always greater than 0° includes:
[0024] In the case where it is determined that the relative rotation angle between the second last connection axis and the next last connection axis is less than or equal to 0° according to the transfer matrix MP, the shape and size parameters of the flange, the connection angle between the flange and the grabbing member, and the shape and size parameters of the grabbing member;
[0025] Controlling and increasing the connection angle between the flange and the grabbing member;
[0026] Until the relative rotation angle between the second last connecting axis and the next last connecting axis determined according to the transfer matrix MP, the shape and size parameters of the flange, the connection angle between the flange and the grabbing member after adjustment, and the shape and size parameters of the grabbing member is greater than 0°.
[0027] In a third aspect, the present application discloses a storage medium, wherein the storage medium stores execution instructions, and the instructions are executed by a controller to implement the method described in the second aspect.
[0028] In a fourth aspect, the present application discloses a vehicle, comprising the robot as described in the first aspect.
[0029] In the above scheme, by adjusting the connection angle between the flange and the grabbing piece, the transfer matrix MF of the end where the last connecting axis is connected to the flange can be changed. In the process where the robot arm drives the grabbing piece to move from one position to a destination, the rotation angles of the second-to-last connecting axis and the second-to-last connecting axis can be changed. The rotation angles of the second-to-last connecting axis and the second-to-last connecting axis can be always greater than 0°, thereby allowing the robot to avoid singularities. BRIEF DESCRIPTION OF THE DRAWINGS
[0030] In order to more clearly illustrate the technical solution of the embodiments of the present application, the drawings required for use in the embodiments of the present application will be described below.
[0031] Figure 1 A schematic diagram of the three-dimensional structure of a robot provided in an embodiment of the present application;
[0032] Figure 2 A plan view of a robot provided in an embodiment of the present application;
[0033] Figure 3 A schematic diagram of the structure of a flange provided in an embodiment of the present application;
[0034] Figure 4 A schematic diagram of the three-dimensional structure of the support bracket provided in an embodiment of the present application;
[0035] Figure 5 A flowchart of a method for a robot to avoid singularities provided in an embodiment of the present application.
[0036] Description of reference numerals:
[0037] 100. Robotic arm; 110. Last connecting shaft; 120. Next to last connecting shaft; 130. Next to last connecting shaft; 140. Flange; 141. First end face; 142. Second end face; 150. Grabbing member; 200. Support bracket; 300. Photovoltaic panel. DETAILED DESCRIPTION
[0038] In order to make the objectives, technical solutions and advantages of the present application clearer, the present application will be further described in detail below in conjunction with the accompanying drawings.
[0039] See also Figure 1-Figure 4 The present application discloses a robot, which is used to pave a photovoltaic panel 300 to a set position at a preset inclination angle. The robot includes a robot arm 100, a flange 140, a gripper 150 and a controller.
[0040] The flange 140 is connected between the mechanical arm 100 and the gripper 150. The gripper 150 is used to grip and release the photovoltaic panel 300. The controller is electrically connected to the mechanical arm 100. The controller can control the mechanical arm 100 to move so that the gripper 150 moves the photovoltaic panel 300 at one position to another position. Specifically, the controller controls the mechanical arm 100 to grip the photovoltaic panel 300 at position A, and the controller controls the mechanical arm 100 to move so that the gripper 150 lays the gripped photovoltaic panel 300 at position B.
[0041] In the embodiment provided in the present application, the robot arm 100 includes a plurality of connecting shafts connected in sequence, and two adjacent connecting shafts are rotationally connected; when the controller controls the movement of the robot arm 100, two adjacent connecting shafts among the plurality of connecting shafts can rotate relative to each other.
[0042] In the embodiment provided in the present application, the connection angle between the grabbing member 150 and the flange 140 can be adjusted. It should be noted that the connection angle between the grabbing member 150 and the flange 140 is the angle between the axis of the flange 140 and the grabbing direction of the grabbing member 150 for grabbing photovoltaics.
[0043] In the embodiment provided in the present application, the robot installs the photovoltaic panel 300 on the support bracket 200, and the support bracket 200 has a load-bearing inclined surface, and the load-bearing inclined surface has an inclination angle with the horizontal plane, and the inclination angle is greater than 0° and less than 90°. When the robot installs the photovoltaic panel 300 on the load-bearing inclined surface, the angle between the photovoltaic panel 300 and the horizontal plane is the inclination angle.
[0044] In the embodiment provided in the present application, the controller is used to obtain the transfer matrix MP of the center point of the photovoltaic panel 300 set at the set position according to the inclination angle of the photovoltaic panel 300 when it is installed at the set position and the height of the photovoltaic panel 300 from the ground when it is installed at the set position; the controller is also used to determine the relative rotation angle between the next-to-last connecting axis and the next-to-last connecting axis 130 according to the transfer matrix MP, the shape and size parameters of the flange 140, the connection angle between the flange 140 and the grabbing member 150, and the shape and size parameters of the grabbing member 150; the controller is used to control the connection angle between the flange 140 and the grabbing member 150 to control the relative rotation angle between the next-to-last connecting axis and the next-to-last connecting axis 130, so that the relative rotation angle between the next-to-last connecting axis and the next-to-last connecting axis 130 is always greater than 0°.
[0045] It should be noted that the photovoltaic panel 300 is set at the set position, which can be understood as setting the photovoltaic panel 300 in the set area of the load-bearing inclined surface of the support bracket 200. Exemplarily, the load-bearing inclined surface of the support bracket 200 includes a set position P1, a set position P2, a set position P3 and a set position P4, and the controller can control the movement of the mechanical arm 100 to drive the movement of the gripping member 150, thereby placing the photovoltaic panel on the set position P1. The controller can control the movement of the mechanical arm 100 to drive the movement of the gripping member 150, thereby placing the photovoltaic panel on the set position P2. The controller can control the movement of the mechanical arm 100 to drive the movement of the gripping member 150, thereby placing the photovoltaic panel on the set position P3, and the controller can also control the movement of the mechanical arm 100 to drive the movement of the gripping member 150, thereby placing the photovoltaic panel on the set position P4.
[0046] The flange 140 includes a first end face 141 and a second end face 142 that are arranged opposite to each other. The first end face 141 is connected to the last connecting shaft 110 among the multiple connecting shafts, and the second end face 142 is connected to the grabbing member 150. The first end face 141 and the second end face 142 form an angle greater than 0° and less than 90°.
[0047] The shape and size parameters of the flange 140 include the effective size of the flange 140 along the axial direction, and the angle formed by the first end face 141 and the second end face 142. The effective length of the flange 140 along the axial direction is the size from the center point of the second end face 142 to the first end face 141 along the axial direction of the flange 140. The center point of the second end face 142 is the geometric center of the second end face 142. If the second end face 142 is circular, the center point of the second end face 142 is the center of the circle. If the second end face 142 is rectangular, the center point of the second end face 142 is the intersection of the diagonal lines of the rectangle. The shape and size parameters of the gripping member 150 include the size of the gripping member 150 along the gripping direction. In the case of determining the transfer matrix MP of the center point of the photovoltaic panel 300 set at the set position, the transfer matrix MF of the end of the last connecting shaft 110 close to the flange 140 can be determined according to the shape and size parameters of the flange 140 and the size of the gripping member 150 along the gripping direction. The shape and size parameters of the flange 140 include the effective size of the flange 140 along the axial direction and the angle formed by the first end surface 141 and the second end surface 142 .
[0048] The controller can transform the matrix according to the transfer matrix MF to obtain the rotation angle of the next-to-last connecting axis 130 of the robot arm 100 relative to the next-to-last connecting axis 120. It should be noted that the rotation angle of the next-to-last connecting axis 120 of the robot arm 100 obtained by the controller according to the transfer matrix MF and the concept of inverse kinematics is a temporary rotation angle. The controller determines whether the temporary rotation angle is greater than 0. When the temporary rotation angle is greater than 0, the temporary rotation angle is determined to be the final rotation angle. When the temporary rotation angle is less than or equal to 0, the rotation angle of the gripping member 150 and the flange 140 is adjusted until the controller obtains that the temporary rotation angles of the next-to-last connecting axis 120 and the next-to-last connecting axis 130 are greater than 0 according to the transfer matrix MF and the concept of inverse kinematics. In this way, when the controller controls the movement of the robot arm 100, since the rotation angle of the next-to-last connecting axis 130 relative to the next-to-last connecting axis 120 is always greater than 0, the axes of the last connecting axis 110, the next-to-last connecting axis 120, and the next-to-last connecting axis 130 will not be collinear at the same time, and the controller can control the robot arm 100 to avoid singularities.
[0049] In the embodiment provided in the present application, the robot arm 100 includes a first connecting shaft, a second connecting shaft, a third connecting shaft, a fourth connecting shaft, a fifth connecting shaft and a sixth connecting shaft connected in sequence. The flange 140 is connected between the sixth connecting shaft and the gripper 150 .
[0050] The fourth connecting shaft is the next-to-last connecting shaft 130 , the fifth connecting shaft is the next-to-last connecting shaft 120 , and the sixth connecting shaft is the last connecting shaft 110 .
[0051] In the embodiment provided in the present application, the rotation angle between the next-to-last connecting shaft 120 and the next-to-last connecting shaft 130 is always greater than a set threshold, and the set threshold is greater than 0° and less than or equal to 5°.
[0052] In the embodiment provided in the present application, the controller controls the rotation angle between adjacent connection axes when the robot arm 100 moves. In order to avoid the robot arm 100 reaching a singularity point during movement, the controller will determine in advance whether the rotation angles of the next-to-last connecting axis 120 (fifth connecting axis) and the next-to-last connecting axis 130 (fourth connecting axis) are always greater than the set threshold value during the process of the robot arm 100 driving the grasping member 150 to move from a position to a destination. If the relative rotation angle of the next-to-last connecting axis 120 (fifth connecting axis) and the next-to-last connecting axis 130 (fourth connecting axis) is less than the set threshold value during the process of the robot arm 100 driving the grasping member 150 to move from a position to a destination, the motion trajectory of the robot arm 100 driving the grasping member 150 from a position to a destination can be changed by adjusting the connection angle of the flange 140 and the grasping member 150, so that during the movement of the robot arm 100, the relative rotation angle of the next-to-last connecting axis 120 (fifth connecting axis) and the next-to-last connecting axis 130 (fourth connecting axis) is greater than the set threshold value, thereby avoiding the robot arm 100 from moving to a singularity point.
[0053] In the embodiment provided in the present application, the connection angle between the flange 140 and the gripper 150 is 10° to 45°. In the process of paving the photovoltaic panel 300, the photovoltaic panel 300 located at position A is generally moved to position B for paving. During this movement of the robot 100, the next-to-last rotation axis, the next-to-last rotation axis and the last rotation axis may be collinear at the same time and reach a singular point. In the present application, the connection angle between the flange 140 and the gripper 150 is 10° to 45°. The connection angle between the flange 140 and the gripper 150 can be used to change the relative rotation angle between the next-to-last rotation axis and the next-to-last rotation axis during the movement of the robot 100 from one position to the destination, further avoiding the situation where the next-to-last rotation axis, the next-to-last rotation axis and the last rotation axis are collinear at the same time, thereby avoiding the robot 100 from moving to a singular point.
[0054] The flange 140 includes a first end face 141 and a second end face 142 that are arranged opposite to each other, the first end face 141 is connected to the last connecting shaft 110, the second end face 142 is connected to the grabbing member 150, and the first end face 141 and the second end face 142 form an angle greater than 0° and less than 45°. In the embodiment provided in the present application, the first end face 141 and the second end face 142 are arranged obliquely, the first end face 141 is connected to the sixth connecting shaft along the axial direction of the flange 140, and the second end face 142 is connected to the grabbing member 150 along the normal direction perpendicular to the second end face 142, so that the flange 140 and the grabbing member 150 form a connection angle greater than 0° and less than 45°.
[0055] In the embodiment provided in the present application, the robot further includes a driving member, which is used to drive the gripping member 150 to control the pitch angle of the gripping member 150 relative to the flange 140 to control the connection angle between the gripping member 150 and the flange 140. The driving member is controlled by the controller, and the controller can control the driving member to drive the gripping member 150 to rotate relative to the flange 140, thereby controlling the connection angle between the flange 140 and the control member.
[0056] In the embodiment provided in the present application, the connection angle between the flange 140 and the control member can be set before the robot moves from one position to a destination, and during the process of the robot moving from one position to a destination, the controller does not adjust the connection angle between the flange 140 and the control member.
[0057] See also Figure 5 The present application also provides a method for a robot to avoid singularity points, the method is applied to the robot as described above, and the method comprises:
[0058] S101, determining a transfer matrix MP of a center point of a photovoltaic panel at a set position according to an inclination angle of the photovoltaic panel when the photovoltaic panel is paved at the set position, a height from the ground when the photovoltaic panel is paved at the set position, and the set position;
[0059] S102, determining a relative rotation angle between the next last connection axis and the next next last connection axis according to the transfer matrix MP, the shape and size parameters of the flange, the connection angle between the flange and the grabber, and the shape and size parameters of the grabber;
[0060] The shape and size parameters of the flange 140 include the effective size of the flange 140 along the axial direction, and the angle formed by the first end face 141 and the second end face 142. The effective length of the flange 140 along the axial direction is the size from the center point of the second end face 142 to the first end face 141 along the axial direction of the flange 140. The center point of the second end face 142 is the geometric center of the second end face 142. If the second end face 142 is circular, the center point of the second end face 142 is the center of the circle. If the second end face 142 is rectangular, the center point of the second end face 142 is the intersection of the diagonal lines of the rectangle. The shape and size parameters of the gripping member 150 include the size of the gripping member 150 along the gripping direction. In the case of determining the transfer matrix MP of the center point of the photovoltaic panel 300 set at the set position, the transfer matrix MF of the last connecting axis 110 of the multiple connecting axes close to the flange 140 can be obtained according to the shape and size parameters of the flange 140 and the size of the gripping member 150 along the gripping direction. The shape and size parameters of the flange 140 include the effective size of the flange 140 along the axial direction and the angle formed by the first end surface 141 and the second end surface 142 .
[0061] S103, adjusting the connection angle between the flange and the grabbing member to adjust the relative rotation angle between the next-to-last connecting shaft and the next-to-last connecting shaft, so that the relative rotation angle between the next-to-last connecting shaft and the next-to-last connecting shaft is always greater than 0°.
[0062] The controller can transform the matrix according to the transfer matrix MF to obtain the rotation angle of the next-to-last connecting axis 130 of the robot arm 100 relative to the next-to-last connecting axis 120. It should be noted that the relative rotation angle of the next-to-last connecting axis 120 of the robot arm 100 obtained by the controller according to the transfer matrix MF and the concept of inverse kinematics is a temporary rotation angle. The controller determines whether the temporary rotation angle is greater than 0. When the temporary rotation angle is greater than 0, the temporary rotation angle is determined to be the final rotation angle. When the temporary rotation angle is less than or equal to 0, the rotation angle of the gripping member 150 and the flange 140 is adjusted until the relative rotation angle of the next-to-last connecting axis 130 and the next-to-last connecting axis 120 obtained by the controller according to the transfer matrix MF and the concept of inverse kinematics is greater than 0. In this way, when the controller controls the movement of the robot arm 100, since the relative rotation angle of the next-to-last connecting axis 130 with respect to the next-to-last connecting axis 120 is always greater than 0, the axes of the last connecting axis 110, the next-to-last connecting axis 120, and the next-to-last connecting axis 130 will not be collinear at the same time, and the controller can control the robot arm 100 to avoid singularities.
[0063] In the embodiment provided in the present application, the relative rotation angle between the next-to-last connecting shaft 120 and the next-to-last connecting shaft 130 is determined according to the transfer matrix MP, the shape and size parameters of the flange 140, the connection angle between the flange 140 and the grabber 150, and the shape and size parameters of the grabber 150, including:
[0064] The transfer matrix ME of the end of the flange 140 connected to the grabbing member 150 is obtained according to the transfer matrix MP, the shape and size parameters of the grabbing member 150, and the connection angle between the flange 140 and the grabbing member 150;
[0065] According to the transfer matrix ME, the shape and size parameters of the flange 140, and the connection angle between the flange 140 and the grabber 150, the transfer matrix MF of the end of the last connecting shaft 110 among the multiple connecting shafts connected to the flange 140 is obtained;
[0066] The relative rotation angle between the second-to-last connecting axis and the second-to-last connecting axis is determined based on the transfer matrix MF.
[0067] In the embodiment provided in the present application, the connection angle between the flange 140 and the grabbing member 150 is adjusted to adjust the relative rotation angle between the next-to-last connecting shaft 120 and the next-to-last connecting shaft 130, so that the rotation angle of the rotation joint between the next-to-last connecting shaft 120 and the next-to-last connecting shaft 130 is always greater than 0°, including:
[0068] In the case where it is determined that the relative rotation angle between the next last connection axis and the next last connection axis 120 is less than or equal to 0 according to the transfer matrix MP, the shape and size parameters of the flange 140, the connection angle between the flange 140 and the grabbing member 150, and the shape and size parameters of the grabbing member 150;
[0069] Adjust the connection angle between the flange 140 and the grabbing member 150;
[0070] Until the relative rotation angle of the rotational joint between the next-to-last connecting shaft 130 and the next-to-last connecting shaft 120 is determined to be greater than 0 based on the transfer matrix MP, the shape and size parameters of the flange 140, the adjusted connection angle between the flange 140 and the grabbing member 150, and the shape and size parameters of the grabbing member 150.
[0071] It should be noted that making the rotation angle of the rotation joint between the next-to-last connecting axis 120 and the next-to-last connecting axis 130 always greater than 0° means that, in the process of the robot arm 100 driving the grasping member 150 to move from any position to a destination (for example, moving from position A to a set position P1), during the relative rotation of the next-to-last connecting axis 120 and the next-to-last connecting axis 130, there is always an angle greater than a set threshold between the axis of the next-to-last connecting axis 120 and the axis of the next-to-last connecting axis 130, and the relative positions of the next-to-last connecting axis 120 and the next-to-last connecting axis 130 do not change. For example, before the movement of the robot arm 100, the grasping member 150 is located at position A, at which time the next-to-last connecting axis 120 is located at the lower side of the next-to-last connecting axis 130; after the movement of the robot arm 100, the grasping member 150 is located at the set position P1, at which time the next-to-last connecting axis 120 is still located at the lower side of the next-to-last connecting axis 130. If before the robot arm 100 moves, the grabbing member 150 is located at position A, at this time the next-to-last connecting shaft 120 is located on the upper side of the next-to-last connecting shaft 130, after the robot arm 100 moves, the grabbing member 150 is located at the set position P1, at this time the next-to-last connecting shaft 120 is still located on the upper side of the next-to-last connecting shaft 130.
[0072] The present application also provides a storage medium, which stores execution instructions, and the instructions are executed by a controller to implement a method for a robot to avoid singularities.
[0073] The present application also discloses a vehicle, which includes the above-mentioned robot.
[0074] It should be noted that all directional indications in the embodiments of the present application (such as up, down, left, right, front, back, etc.) are only used to explain the relative position relationship, movement status, etc. between the components under a certain specific posture (as shown in the accompanying drawings). If the specific posture changes, the directional indication will also change accordingly.
[0075] In addition, the descriptions of "first", "second", etc. in this application are only for descriptive purposes and cannot be understood as indicating or implying their relative importance or implicitly indicating the number of the indicated technical features. Therefore, the features defined as "first" or "second" may explicitly or implicitly include at least one of the features. In the description of this application, the meaning of "plurality" is at least two, such as two, three, etc., unless otherwise clearly and specifically defined.
[0076] In this application, unless otherwise clearly specified and limited, the terms "connection", "fixation", etc. should be understood in a broad sense. For example, "fixation" 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, unless otherwise clearly defined. For ordinary technicians in this field, the specific meanings of the above terms in this application can be understood according to specific circumstances.
[0077] In addition, the technical solutions between the various embodiments of the present application can be combined with each other, but it must be based on the fact that ordinary technicians in the field can implement it. When the combination of technical solutions is contradictory or cannot be implemented, it should be deemed that such combination of technical solutions does not exist and is not within the scope of protection required by this application.
[0078] The above is only a specific implementation of the present application, but the protection scope of the present application is not limited thereto. Any person skilled in the art who is familiar with the present technical field can easily think of changes or substitutions within the technical scope disclosed in the present application, which should be included in the protection scope of the present application. Therefore, the protection scope of the present application should be based on the protection scope of the claims.
Claims
1. A robot, It is characterized in that The robot is used to pave the photovoltaic panel to a set position at a preset inclination angle, and the robot comprises: The mechanical arm has a plurality of connecting shafts connected in sequence, and two adjacent connecting shafts are rotationally connected; A flange connected to the last connecting shaft among the plurality of connecting shafts; A gripping member connected to the flange, the gripping member being used to grip and release the photovoltaic panel; A controller, electrically connected to the robotic arm; Among them, the controller is used to determine the transfer matrix MP of the photovoltaic panel set at the center point of the set position according to the inclination angle when the photovoltaic panel is paved at the set position and the height from the ground when the photovoltaic panel is paved at the set position; the controller is also used to determine the relative rotation angle between the next-to-last connecting axis and the next-to-last connecting axis according to the transfer matrix MP, the shape and size parameters of the flange, the connection angle between the flange and the grabbing member, and the shape and size parameters of the grabbing member; the controller is also used to control the connection angle between the flange and the grabbing member to control the relative rotation angle between the next-to-last connecting axis and the next-to-last connecting axis, so that the relative rotation angle between the next-to-last connecting axis and the next-to-last connecting axis is always greater than 0°.
2. The robot according to claim 1, It is characterized in that The relative rotation angle between the second-to-last connecting shaft and the second-to-last connecting shaft is always greater than a set threshold, and the set threshold is greater than or equal to 0° and less than or equal to 5°.
3. The robot according to claim 1 or 2, It is characterized in that The connection angle between the flange and the grabbing member is 10° to 45°.
4. The robot according to claim 3, It is characterized in that The flange includes a first end face and a second end face arranged opposite to each other, the first end face is connected to the last connecting shaft among multiple connecting shafts, the second end face is connected to the grabbing member, and the first end face and the second end face form an angle greater than 0° and less than 45°.
5. The robot according to claim 4, It is characterized in that The robot further comprises a driving member, wherein the driving member is used to drive the grasping member to control a pitch angle of the grasping member relative to the flange to control a connection angle between the grasping member and the flange.
6. A method for a robot to avoid singularity points, It is characterized in that The method is applied to the robot according to any one of claims 1 to 5, and the method comprises: Determine the transfer matrix MP of the center point of the photovoltaic panel at the set position according to the inclination angle of the photovoltaic panel when it is paved at the set position, the height of the photovoltaic panel from the ground when it is paved at the set position, and the set position; Determine the relative rotation angle between the next last connection axis and the next next last connection axis according to the transfer matrix MP, the shape and size parameters of the flange, the connection angle between the flange and the grabbing member, and the shape and size parameters of the grabbing member; The connection angle between the flange and the grabbing member is adjusted to adjust the relative rotation angle between the second last connecting shaft and the second last connecting shaft, so that the relative rotation angle between the second last connecting shaft and the second last connecting shaft is always greater than 0°.
7. The method according to claim 6, It is characterized in that The determining of the relative rotation angle between the second last connection axis and the next last connection axis according to the transfer matrix MP, the shape and size parameters of the flange, the connection angle between the flange and the grabbing member, and the shape and size parameters of the grabbing member comprises: According to the transfer matrix MP, the shape and size parameters of the grabbing member, and the connection angle between the flange and the grabbing member, a transfer matrix ME of the end of the flange connected to the grabbing member is obtained; Determine the transfer matrix MF of the end of the last connecting shaft among the multiple connecting shafts connected to the flange according to the transfer matrix ME, the shape and size parameters of the flange, and the connection angle between the flange and the grabbing member; The relative rotation angle between the second-to-last connecting axis and the second-to-last connecting axis is determined based on the transfer matrix MF.
8. The method according to claim 6, It is characterized in that The step of adjusting the connection angle between the flange and the grabbing member to adjust the relative rotation angle between the next-to-last connecting shaft and the next-to-last connecting shaft so that the relative rotation angle between the next-to-last connecting shaft and the next-to-last connecting shaft is always greater than 0° includes: In the case where it is determined that the relative rotation angle between the second last connection axis and the next last connection axis is less than or equal to 0° according to the transfer matrix MP, the shape and size parameters of the flange, the connection angle between the flange and the grabbing member, and the shape and size parameters of the grabbing member; Adjusting the connection angle between the flange and the grabbing member; Until the relative rotation angle between the second last connecting axis and the next last connecting axis determined according to the transfer matrix MP, the shape and size parameters of the flange, the adjusted connection angle between the flange and the grabbing member, and the shape and size parameters of the grabbing member is greater than 0°.
9. A storage medium, It is characterized in that The storage medium stores execution instructions, and the instructions are executed by the controller to implement the method according to any one of claims 6 to 8.
10. A vehicle, It is characterized in that The vehicle comprises a robot as described in any one of claims 1-5.
Citation Information
Patent Citations
Industrial robot singularity-avoiding end effector connecting device and singularity-avoiding method
CN113183148A
Photovoltaic panel mounting robot and photovoltaic panel mounting method
CN117260672A
Photovoltaic module automatic installation robot and method thereof
CN117301083A
Multifunctional composite clamping jaw with biased singular point of robot
CN218364804U
Mechanical arm for photovoltaic panel installation
CN219837792U
