给我一段三维比例导引的MATLAB代码

以下是一个简单的三维比例导引代码示例：

% 定义初始位置和速度矢量
r0 = [0 0 0];
v0 = [0.1 0.2 0.3];

% 定义目标位置矢量
rt = [1 2 3];

% 定义比例导引增益参数
Kp = 0.5;

% 定义时间步长和仿真时间
dt = 0.01;
t = 0:dt:10;

% 初始化位置和速度矢量
r = r0;
v = v0;

% 循环仿真
for i = 1:length(t)
    % 计算加速度矢量
    a = Kp * (rt - r) - v;
    
    % 更新速度和位置矢量
    v = v + a * dt;
    r = r + v * dt;
    
    % 绘制当前位置
    plot3(r(1), r(2), r(3), 'r.');
    hold on;
    
    % 绘制目标位置
    plot3(rt(1), rt(2), rt(3), 'bo');
    
    % 设置图形属性
    axis equal;
    xlim([-1 3]);
    ylim([-1 3]);
    zlim([-1 3]);
    xlabel('x');
    ylabel('y');
    zlabel('z');
    
    % 暂停一段时间
    pause(0.01);
    
    % 清空图形
    cla;
end

该代码使用比例导引控制算法将物体从初始位置移动到目标位置。其中，$r$ 和 $v$ 分别表示位置和速度矢量，$rt$ 表示目标位置矢量，$Kp$ 表示比例导引增益参数，$dt$ 表示时间步长，$t$ 表示仿真时间。在循环中，首先计算加速度矢量 $a$，然后更新速度和位置矢量，绘制当前位置和目标位置，并暂停一段时间，最后清空图形。