資源簡介
最近在做一個12自由度四足機器人的項目,每條腿3個自由度。涉及到足端位姿關(guān)節(jié)逆解的問題,于是進行了簡單的推導(dǎo),并且編寫了Matlab仿真程序,有需要的童鞋可以點擊下載。
四足機器人腿步有肘式和膝式之分,很好理解,顧名思義。因為想要探索一下前肘后膝四足機器人和雙肘式、雙膝式的不同,因此推導(dǎo)了兩種腿部關(guān)節(jié)的逆解。為了簡單起見,沒有用到《機器人學》復(fù)雜的坐標轉(zhuǎn)換,只需要基礎(chǔ)的初高中幾何知識就可以理解。
包含forword_kinamic_x.m forword_kinamic_z.m invar_kinamic_x.m invar_kinamic_z.m四個文件,分別對應(yīng)著肘式、膝式的正逆解運算。

代碼片段和文件信息
%%?單腿正運動學模型——膝式
function?[AxAyAzBxByBzCxCyCz]=forword_kinamic_x(abcq1q2q3)
Ax=0;
Ay=a*sin(q3);
Az=-a*cos(q3);
Bx=b*sin(q2);
By=(b*cos(q2)+a)*sin(q3);
Bz=-(b*cos(q2)+a)*cos(q3);
Cx=b*sin(q2)-c*cos(q2+q1);
Cy=(b*cos(q2)+a+c*sin(q2+q1))*sin(q3);
Cz=-(b*cos(q2)+a+c*sin(q2+q1))*cos(q3);
end
?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----
?????文件?????????330??2019-09-11?13:22??3自由度機械臂正逆解matlab\forword_kinamic_x.m
?????文件?????????343??2019-09-11?13:22??3自由度機械臂正逆解matlab\forword_kinamic_z.m
?????文件?????????367??2019-09-11?13:22??3自由度機械臂正逆解matlab\invar_kinamic_x.m
?????文件?????????369??2019-09-11?13:22??3自由度機械臂正逆解matlab\invar_kinamic_z.m
?????目錄???????????0??2019-09-11?17:10??3自由度機械臂正逆解matlab\
評論
共有 條評論