straightline.m

来自「一个用粒子群做的路径规划。功能比较简单」· M 代码 · 共 4 行

%----求直线方程，知道两点得出直线的k和b值
function [k,b] = straightLine(x1,y1,x2,y2)
k =( y2-y1 )/( x2-x1 );
b = y1 - x1*k;