文章目录
Robot_Pos.X+=(Robot_Vel.X * cos(Robot_Pos.Z) - Robot_Vel.Y * sin(Robot_Pos.Z)) * Sampling_Time;
//Calculate the displacement in the X direction, unit: m //计算X方向的位移,单位:m
Robot_Pos.X+=(Robot_Vel.X * cos(Robot_Pos.Z) - Robot_Vel.Y * sin(Robot_Pos.Z)) * Sampling_Time;
//Calculate the displacement in the X direction, unit: m //计算X方向的位移,单位:m