//根据合成速度计算x轴和y轴速度 

//RXXW_Dor 

//2025-03-17 

//2点之间的直线距离 

 FC_Calcu_PointDistance(P_0 := P_0,P_1 := P_1,rDistance => rDistance); 

IF rDistance>0.0 THEN
9 Vx:=Vl*(P_1.x-p_0.x)/rDistance; //X轴速度

 Vy:=Vl*(P_1.y-p_0.y)/rDistance; //y轴速度 

 ELSE 

    Vx:=0.0; 

    Vy:=0.0; 

 END_IF;