Get_GridID_Set_at_GPS_Singal_Blockage.m

function [ GridIDSet_at_GPS_Singal_Blockage_matrix, GridIDSet_at_GPS_Singal_Blockage_vector ]  = Get_GridID_Set_at_GPS_Singal_Blockage
    %% Get_GridID_Set_at_GPS_Singal_Blockage function description:
    % Imput:
    % Output:
    % GridID_LineID_near_GPS: Grid_ID, line num, line ID 12345....n
    %
    % Example
    % [ GridIDSet_at_GPS_Singal_Blockage_matrix, GridIDSet_at_GPS_Singal_Blockage_vector ]  = Get_GridID_Set_at_GPS_Singal_Blockage
    % Revision Notes:
    %       (10/04/14)
    % by shenghua chen
    
    %%
    load GPS_data_bl_xy.txt;
    % gps id, time, Latitude, Longitude, x, Y
    interpolating_GPS = [];
    i_interpolating_GPS = 0;
    
    distance = [];
    for i_gps = 1:size(GPS_data_bl_xy,1)-1
        distance (i_gps ) = sqrt((GPS_data_bl_xy(i_gps,5) - GPS_data_bl_xy(i_gps+1,5)).^2 ...
            + (GPS_data_bl_xy(i_gps,6) - GPS_data_bl_xy(i_gps+1,6)).^2);
        
        if distance (i_gps ) > 200
            %% interpolating for more gps.
            distance (i_gps )
            i_gps
            point_num = ceil(distance (i_gps )/100);
            for ii = 1:(point_num-1)
                i_interpolating_GPS = i_interpolating_GPS + 1;
                interpolating_GPS(i_interpolating_GPS,1) = GPS_data_bl_xy(i_gps,5) + ii*(GPS_data_bl_xy(i_gps+1,5) - GPS_data_bl_xy(i_gps,5))/point_num;
                interpolating_GPS(i_interpolating_GPS,2) = GPS_data_bl_xy(i_gps,6) + ii*(GPS_data_bl_xy(i_gps+1,6) - GPS_data_bl_xy(i_gps,6))/point_num;
            end
        end
    end
    
    GridIDSet_at_GPS_Singal_Blockage_matrix = zeros(size(interpolating_GPS,1),7);
    % x,y, gridID num, grid 1234;    
    
    QuadtreeStructure = Build_QuadtreeStructure_with_GPS_Lines_near_GPS;
    % QuadtreeStructure: Grid_side_length, Start_x, Start_y, Grid_x_num, Grid_y_num
    
    
    fid_GridIDSet_at_GPS_Singal_Blockage_matrix = fopen('GridIDSet_at_GPS_Singal_Blockage_matrix.txt', 'wt');
    
    for i_gps = 1:size(interpolating_GPS,1)
        x_GPS = interpolating_GPS(i_gps,1);
        y_GPS = interpolating_GPS(i_gps,2);
        x_min_grid = ceil((x_GPS-20-QuadtreeStructure(2))/QuadtreeStructure(1));
        x_max_grid = ceil((x_GPS+20-QuadtreeStructure(2))/QuadtreeStructure(1));
        y_min_grid = ceil((y_GPS-20-QuadtreeStructure(3))/QuadtreeStructure(1));
        y_max_grid = ceil((y_GPS+20-QuadtreeStructure(3))/QuadtreeStructure(1));
        
        GridIDSet_at_GPS_Singal_Blockage_matrix(i_gps,1) = interpolating_GPS(i_gps,1);
        GridIDSet_at_GPS_Singal_Blockage_matrix(i_gps,2) = interpolating_GPS(i_gps,2);
        GridIDSet_at_GPS_Singal_Blockage_matrix(i_gps,3) = (x_max_grid - x_min_grid + 1)*(y_max_grid - y_min_grid + 1);
        k_grid = 3;
        for i_x_grid = x_min_grid:x_max_grid
            for i_y_grid = y_min_grid:y_max_grid
                k_grid = k_grid + 1;
                GridIDSet_at_GPS_Singal_Blockage_matrix(i_gps,k_grid) = (i_y_grid-1)*QuadtreeStructure(4)+i_x_grid;
            end
        end
        fprintf(fid_GridIDSet_at_GPS_Singal_Blockage_matrix, '%16.5f\t',GridIDSet_at_GPS_Singal_Blockage_matrix(i_gps,1));
        fprintf(fid_GridIDSet_at_GPS_Singal_Blockage_matrix, '%16.5f\t',GridIDSet_at_GPS_Singal_Blockage_matrix(i_gps,2));
        for ii_file_line = 3:7
            fprintf(fid_GridIDSet_at_GPS_Singal_Blockage_matrix, '%d\t',GridIDSet_at_GPS_Singal_Blockage_matrix(i_gps,ii_file_line));
        end
        fprintf(fid_GridIDSet_at_GPS_Singal_Blockage_matrix, '\n');
    end
    
    %% get all the grid ID set near the Singal Blockage
    GridIDSet = GridIDSet_at_GPS_Singal_Blockage_matrix(:,4:7);
    GridIDSet = GridIDSet(:);
    GridIDSet = unique(GridIDSet);
    GridIDSet = GridIDSet';
    GridIDSet = GridIDSet (2:end);   % delete the zero
    GridIDSet_at_GPS_Singal_Blockage_vector = GridIDSet
    fid_GridIDSet_at_GPS_Singal_Blockage_vector = fopen('GridIDSet_at_GPS_Singal_Blockage_vector.txt', 'wt');
    for ii_grid = 1:size(GridIDSet,2)
        fprintf(fid_GridIDSet_at_GPS_Singal_Blockage_vector, '%d\n',GridIDSet(ii_grid));
    end
    
    % close
    fclose(fid_GridIDSet_at_GPS_Singal_Blockage_matrix);
    fclose(fid_GridIDSet_at_GPS_Singal_Blockage_vector);    
end