RV-M1 inverse kinematics

5 views (last 30 days)
Hi! I am trying to instruct RV-M1, a 5-DOF manipulator, to write the letters EEE on a paper. First, I explicitly defined the points of all vertices of EEE, including the intermediate points when traversing the spaces between each E. Next, I defined the cost function with inputs joint angles and defined points, cost(joint_angles,defined_points). The cost function is defined as the square of the difference between computed points and the explicitly defined points. That is, cost = (computed - defined)^2. The computed points are computed using the forward kinematic equations. I now feed the defined points to fmincon. The parameters of fmincon are:
Aeq = [0 1 1 1];
beq = 0
lower and upper bounds of the four joint angles, the last angle is always zero
lb = [-145; -25; -105; -85]
ub= [145; 95; 0; 85]
initial_angles = [0 0 0 0]
fmincon(@(joint_angles) cost(joint_angles, defined points), initial_angles,[],[],Aeq,beq,lb,ub)
However, the joint space I'm getting does not correspond to my explicitly defined points. Where am I wrong? I am happy to send my code if someone can help me.

Accepted Answer

Dario Andres Gomez Campos
Dario Andres Gomez Campos on 19 Apr 2021
Hello, I do not know if you are still interested, but you can check my work in we solve this robot with inverse and direct kinematics.
Greetings,
  1 Comment
Jose Maria Braga
Jose Maria Braga on 22 Apr 2021
Thank you! This is great! Coming from the Philippines, I can understand some Spanish words but, do you, by any chance, have an English version of the manuscript? This is an interesting reading :)

Sign in to comment.

More Answers (0)

Categories

Find more on Simulation in Help Center and File Exchange

Community Treasure Hunt

Find the treasures in MATLAB Central and discover how the community can help you!

Start Hunting!