3link 无障碍物\cross_singlepoint.m ..............\fitnesstra3f.m ..............\forkin3.m ..............\ftorque3.m ..............\invkini.m ..............\main.m ..............\torque3.m ..............\trajectory_planning3f.m ..............\trajt3.m 3link 无障碍物