robot1 = [-1 -1; 0 1; 1 -1];
robot2 = [-1 -1; 1 -1; 1 1; 0 2; -1 1];

pose1 = [-3 3 0];
pose2 = [3 3 pi/2];

figure(1);
axis([-5 5 -2 5])
plot_robot(robot1,'-b');
robot_t = transform_robot(robot1,pose1);
plot_robot(robot_t,'-r');
robot_t = transform_robot(robot1,pose2);
plot_robot(robot_t,'-g');

figure(2);
axis([-5 5 -2 5])
plot_robot(robot2,'-b');
robot_t = transform_robot(robot2,pose1);
plot_robot(robot_t,'-r');
robot_t = transform_robot(robot2,pose2);
plot_robot(robot_t,'-g');