RV-M1 inverse kinematics
2 次查看(过去 30 天)
显示 更早的评论
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.
0 个评论
采纳的回答
Dario Andres Gomez Campos
2021-4-19
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,
更多回答(0 个)
另请参阅
Community Treasure Hunt
Find the treasures in MATLAB Central and discover how the community can help you!
Start Hunting!