编写maltab代码

为了完成上述任务，在Matlab中我们需要实现的主要功能包括：

1. **读取DEM数据**：首先应该读取TIFF格式的数字高程模型(DEM)，这里假设您已经有了读取这部分数据的方法或者是使用了某种工具箱提供的方法。这一步骤将生成一个三维矩阵表示地形的高程信息。

2. **计算坡度及坡向**：基于获取到的高程数据，利用给定公式计算每个网格单元的坡度以及坡向。

    function [slope, aspect] = calculate_slope_aspect(dem)
        dx = conv2(dem, [-1 -2 -1; 0 0 0; 1 2 1], 'same') / 8;
        dy = conv2(dem, [-1 0 1; -2 0 2; -1 0 1], 'same') / 8;

        slope = atan(sqrt(dx.^2 + dy.^2)) * 180 / pi;  % Slope in degrees
        aspect = mod(270 + atan2(dy, dx) * 180 / pi - 90, 360);  % Aspect in degrees

        % Handling horizontal surfaces explicitly.
        horizontal_mask = dx == 0 & dy == 0;
        aspect(horizontal_mask) = 0;
    end

3. **定义成本函数**：对于每一对连续的位置（`points{i}` 和 `points{i+1}`），根据它们之间的距离(`delta_L`)和转角(`delta_theta`)计算相应的成本权重`w`。

    function w = cost_function(delta_L, delta_theta)
        switch true
            case (delta_L == 1 && delta_theta == 0)
                w = 1;
            case (delta_L == 1 && delta_theta == 45)
                w = 1.5;
            case (delta_L == 1 && delta_theta == 90)
                w = 2;
            case (delta_L == 2 && delta_theta == 0)
                w = sqrt(2);
            case (delta_L == 2 && delta_theta == 45)
                w = sqrt(2) + 0.5;
            case (delta_L == 2 && delta_theta == 90)
                w = sqrt(2) + 1;
            otherwise
                error('Undefined conditions!');
        end
    end

4. **遍历所有路径节点计算总的代价**：基于前面定义的成本函数，对整个路径进行评估。

    total_cost = 0;
    n = length(points) - 1; % number of segments
    
    for i = 1:n
        p1 = points(i);
        p2 = points(i+1);
        
        delta_L = norm(p2(1:2) - p1(3) + 180, 360) - 180);
        
        weight = cost_function(delta_L, delta_theta);
        total_cost = total_cost + weight * 5; % Assuming the constant is 5 as per your example
    end
    disp(['Total Cost:', num2str(total_cost)]);

以上给出了基本框架，请根据具体需求调整细节部分。