drawrobotposition.m

该程序用PID系统实现差动转向车辆控制

%% Author: epokh
%% Website: www.epokh.org/drupy
%% This software is under GPL


function DrawRobotPosition(position,bw)
%% This function draw a triangle representing the robot
%%
grid on;
hold on;
left_wheel_pos=LeftWheelLoc(position,bw);
right_wheel_pos=RightWheelLoc(position,bw);
nose_pos=NoseLocation(position,bw);
xpoints=[left_wheel_pos(1) right_wheel_pos(1) nose_pos(1)];
ypoints=[left_wheel_pos(2) right_wheel_pos(2) nose_pos(2)];
fill(xpoints,ypoints,'r');
hold off;
end