Coordinate system

1 Joint coordinate system

The joint coordinate system is determined with reference to each moving joint. All joints are rotary joints. Range of motion is as follows:

Joint Angle
J1 -165 ~ +165
J2 -165 ~ +165
J3 -165 ~ +165
J4 -165 ~ +165
J5 -165 ~ +165
J6 -175 ~ +175

2 User coordinate system

The user coordinate system is a user-defined workbench coordinate system or workpiece coordinate system, whose origin and axis direction can be determined according to actual needs, which can easily measure the position of each point in the working interval and arrange tasks. The default user coordinate system is determined based on the center point of the robot arm base, and the positive direction of the Y axis is the direction of the heavy load line.

3 Tool coordinate system

The Tool coordinate system is a coordinate system that defines the position of the Tool Center Point (TCP) and the tool attitude, and its origin and direction are constantly changing with the position and Angle of the end workpiece. The default tool coordinate system is determined based on the center point of the tool flange, and the positive direction of the Y-axis is the opposite direction of the aviation socket.。

4 Joint connecting rod parameter specifications

4.1 DH definition

For the rotating joint n, set 0=0.0, where the X axis is in the same direction as the X axis, and select the origin position of the coordinate system (N) to satisfy d.=0.0. For the mobile joint n, set the orientation of the 8 axis so that it meets 0.=0.0. When d.=0.0, select the origin of the coordinate system (N) at the intersection of the XN-1 axis and the joint axis n.

Induction of linkage parameters in the linkage coordinate system If the linkage coordinate system is fixed to the linkage according to the above provisions, the linkage parameters can be defined as follows:

  • a_i-1: The distance along x_i-1: from z_i-1 to z_i

  • alpha_i-1: goes around x_i-1: goes from z_i-1 to z_i

  • d_i: indicates the distance from x_i-1 to x_i along z_i:

  • theta_i: around z_i: from the Angle of x_i-1 to x_i

Here is an article to refer to https://blog.csdn.net/hitgavin/article/details/104442034

4.2 SDH Parameter List

关节 theta d alpha a offset
1 theta_1 173.9 PI/2 0 0
2 theta_2 0 0 -135 -PI/2
3 theta_3 0 0 -120 0
4 theta_4 88.78 PI/2 0 -PI/2
5 theta_5 95 -PI/2 0 0
6 theta_6 65.5 0 0 0

← Previous Page | Next Chapter →

results matching ""

    No results matching ""