function plot_triangle(x, y, orientation)
% x = 2; y =2;
% orientation = 45*pi/180;
d = 0.05; %三角形的高度
angle = 70*pi/180; %三角形的角度(等腰三角形的形状)
point1_orign =[0; -d/tan(angle); 1];
point2_orign =[d; 0; 1];
point3_orign =[0; d/tan(angle); 1];
trans =[cos(orientation), -sin(orientation), x;
sin(orientation), cos(orientation), y;
0, 0, 1];
point1 =trans*point1_orign;
point2 =trans*point2_orign;
point3 =trans*point3_orign;
triangle_x=[point1(1), point2(1), point3(1), point1(1)];
triangle_y=[point1(2), point2(2), point3(2), point1(2)];
fill(triangle_x,triangle_y,'b');