matlab代码实现单机器人避障

下面是一个简单的 Matlab 代码示例，用于模拟单机器人的避障行为。该代码使用基本的距离传感器来检测障碍物，并采取简单的避障策略。在这个示例中，我们假设机器人在一个二维平面上移动。

% 定义机器人的初始位置和速度
robot_pos = [0, 0]; % 初始位置
robot_vel = 1; % 速度

% 定义障碍物的位置
obstacle_pos = [3, 3]; % 障碍物位置

% 定义距离传感器的范围
sensor_range = 5;

% 模拟机器人移动
for t = 1:100
    % 计算机器人和障碍物的距离
    distance_to_obstacle = norm(robot_pos - obstacle_pos);
    
    % 如果距离小于传感器范围，执行避障动作
    if distance_to_obstacle < sensor_range
        % 计算机器人朝向障碍物的方向
        direction_to_obstacle = obstacle_pos - robot_pos;
        
        % 调整机器人的速度和方向，使其避开障碍物
        robot_vel = 0.5; % 降低速度
        robot_pos = robot_pos - 0.1 * direction_to_obstacle; % 往相反方向移动
    else
        % 如果没有障碍物，机器人继续直线移动
        robot_pos = robot_pos + robot_vel * [cos(t), sin(t)];
    end
    
    % 绘制机器人和障碍物的位置
    plot(robot_pos(1), robot_pos(2), 'bo'); % 机器人用蓝色圆点表示
    hold on;
    plot(obstacle_pos(1), obstacle_pos(2), 'rx'); % 障碍物用红色叉号表示
    xlim([-5, 5]);
    ylim([-5, 5]);
    xlabel('X');
    ylabel('Y');
    title('Robot Obstacle Avoidance Simulation');
    pause(0.1);
end

这段代码模拟了一个简单的机器人避障行为。当机器人检测到障碍物时，它会减速并朝着相反方向移动一小段距离，以避开障碍物。当没有障碍物时，机器人会继续直线移动。

这只是一个简单的示例，实际的避障算法会更复杂。你可以根据具体的需求和传感器的性能来设计更复杂的避障算法，比如使用激光传感器或者视觉传感器来检测障碍物，或者使用路径规划算法来规划避障路径。