【MATLAB】根据位置和方向绘制三角形

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');