Help with a 4 link robotic arm angle calculations

Hello community,

I'm looking to understand the rotational dynamics of a joint in relation to the actual servo angle, as depicted by the four-link mechanism in the attached image.

The lengths of r1, r2, r3, and r4 are fixed, with θ1 representing the servo angle. My goal is to determine θ2, which will allow me to apply it to a set of inverse/forward kinematic equations.

Here's the robotic arm in question:

Screen Shot 2024-04-29 at 10.47.45 AM

Due to the differing lengths of r2 and r4 in the arm, I'm uncertain about how to establish the correlation between θ1 and θ2. I would be very thankful for any guidance on this matter.

2 circles connected by a line. Write down the 2D equation, solve it.

1 Like

Inverse kinematics is used to determine θ2, as well as other variables.

Calculating θ1 given the values of r1, r2, r3, r4, and θ2 is straightforward. However, the relationship between θ1 and θ2 isn't straightforward—it's not linear. My initial attempt to use a simple proportional relationship, like θ1 = K * θ2 with K being a constant, was inadequate. I've discovered that it's a type of 4-bar linkage, which is governed by the Freudenstein equations listed below. To be frank, solving the system of equations for either angle is turning out to be more complex than I anticipated for a robotic kit designed for educational purposes. We're utilizing PictoBlocks and CodeSkool to develop the scratch sketch, but unfortunately, there's no available scratch extension for this type of robotic arm.

However, the relationship between θ1 and θ2 isn't straightforward—it's not linear.

Vanishingly few problems in inverse kinematics are linear and most have singularities or exhibit multiple solutions.

There are a number of general introductions and tools for solving inverse kinematics problems. This open textbook is a reasonable place to start:
https://opentextbooks.clemson.edu/wangrobotics/chapter/inverse-kinematics/

3 Likes

How are you mapping the 4-bar mechanism to the arm? I can't see how r1 is a fixed constant and would map to the arm's joints.

This is the mapping of the 4-bar mechanism to the arm.

Screen-Shot-2024-04-29-at-10.47.45-AM

1 Like

The equation system solved for θ1:

θ1 = acos((sqrt(2) sqrt(2 sin^2(θ2) - K1^2 sin^2(θ2) - K1^2 sin^2(θ2) cos(2 θ2) - 4 K1 K3 sin^2(θ2) cos(θ2) + 2 K2^2 sin^2(θ2) + 4 K2 sin^2(θ2) cos(θ2) - 2 K3^2 sin^2(θ2)) + 2 K1 cos^2(θ2) + 2 K1 K2 cos(θ2) + 2 K2 K3 + 2 K3 cos(θ2))/(2 (sin^2(θ2) + cos^2(θ2) + K2^2 + 2 K2 cos(θ2))))

Screen Shot 2024-04-29 at 12.42.28 PM

You might find this treatment of Freudenstein's equation useful. The four-bar mechanism has a surprising variety of applications.

freud.pdf (3.2 MB)

2 Likes

This topic was automatically closed 180 days after the last reply. New replies are no longer allowed.