机器人运动规划
逐梦远航
东南大学在职硕士
展开
-
空间圆弧插补算法,matlab实现封装函数
%圆弧插补函数,输入三个坐标,以及插补点个数,得到一组坐标function [trajx,trajy,trajz]=Cir_interpol(N,pos1,pos2,pos3)x1=pos1(1);y1=pos1(2);z1=pos1(3);x2=pos2(1);y2=pos2(2);z2=pos2(3);x3=pos3(1);y3=pos3(2);z3=pos3(3);A1 = y1z...原创 2020-03-10 18:05:49 · 4070 阅读 · 2 评论 -
求空间中任意两个直线段的最短距离,matlab实现
空间直线段最短距离计算公式:点到直线段最短距离公式:%求空间中任意两条直线之间的最短距离,p1p2是直线段p的两个端点坐标,q1q2是直线段q的两个端点坐标function [d]=distance(p1,p2,q1,q2)s1=p2-p1;%方向向量s2=q2-q1;res1=((s1*s2')*((p1-q1)*s2')-(s2*s2')*((p1-q1)*s1'))/((s1*s...原创 2020-03-10 17:12:38 · 5752 阅读 · 1 评论