无人机飞行MATLAB代码

### 无人机飞行 MATLAB 示例代码

#### 航迹规划示例代码
下面展示一段用于无人机航迹规划的基础MATLAB代码，该代码实现了简单的路径生成逻辑：

function path = planPath(startPoint, endPoint, obstacles)
    % 定义起点和终点之间的直线距离作为初始路径
    straightLineDistance = norm(endPoint - startPoint);
    
    % 初始化路径数组
    numPoints = 10; % 假设路径由10个点组成
    path = linspace(startPoint, endPoint, numPoints)';
    
    % 避障处理 (简化版)，实际应用中应采用更复杂的算法
    for i = 1:length(obstacles)
        obstaclePos = obstacles(i,:);
        distToObstacle = min(sqrt(sum((path - repmat(obstaclePos,numPoints,1)).^2,2)));
        
        if distToObstacle < safetyMargin
            disp('检测到障碍物，调整路径...');
            
            % 这里仅简单绕过障碍物，具体方法取决于应用场景
            avoidanceVector = normalize(cross(path(1,:) - obstaclePos, randn(1,3))) * safetyMargin;
            adjustedStart = startPoint + avoidanceVector;
            path(:,1) = adjustedStart';
        end
    end