,定義插補(bǔ)次數(shù)n,根據(jù)驅(qū)動(dòng)器支持的最大插補(bǔ)次數(shù)設(shè)定Time=[0,0,0,0,0,0;5,5,5,5,5,5;10,10,10,10,10,10];StopTime=Time(3,1);FixedStep=0.2;SimpleNum=0:FixedStep:StopTime;Cunt=length(SimpleNum);for i=1:n %% 求每個(gè)關(guān)節(jié)角的五次多項(xiàng)式插補(bǔ)軌跡點(diǎn)