%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
% Show cells in map
min_x  = min(small_dataset(:,2)); 
min_y  = min(small_dataset(:,1));

max_x  = max(small_dataset(:,2)); 
max_y  = max(small_dataset(:,1));

length_x = max_x - min_x;
length_y = max_y - min_y;


% Distance in meters for x and y axis
distance_meter_x = distanceGPS(min_y,min_x,min_y,max_x); % 290.727318201 m
distance_meter_y = distanceGPS(min_y,min_x,max_y,min_x); % 1107.98493863 m

% 10x10 row=110,column=29
% 25x25 row=44,column=12
% 20x20 row=55,column=14
% 30x30 row=37,column=10
% 40x40 row=28,column=7
% 50x50 row=20,column=5

row_num_10=110;
column_num_10=29;

distance_x_10 = length_x/row_num_10;
distance_y_10 = length_y/column_num_10;

my_16_x_first = distance_x_10*14 + min_x + distance_x_10/2;
my_16_y = distance_y_10*26 + min_y + distance_y_10/2;
my_16_x_second = distance_x_10*15 + min_x + distance_x_10/2;
my_16_x_third = distance_x_10*16 + min_x + distance_x_10/2;

store_cell_rss =  zeros(row_num,column_num);
energy_consumption = zeros(row_num,column_num);
for row=1:1:row_num_10
    last_row_value = min_y + ((row - 1)* distance_y_10);
    if row == row_num_10
        next_row_value = max_y + 1;
    else
        next_row_value = min_y + (row * distance_y_10);
    end
    for column=1:1:column_num_10        
        last_column_value = min_x + ((column - 1)* distance_x_10);
        if column == column_num_10
            next_column_value = max_x + 1;
        else
            next_column_value = min_x + (column * distance_x_10);
        end
        if row == row_num && column == column_num
            temp = small_dataset(small_dataset(:,1)>=(min_y + ((row-1)*distance_y_10)) & small_dataset(:,1)<=max_y & ...
                small_dataset(:,2)>=(min_x + ((column-1)*distance_x_10)) & small_dataset(:,2)<=max_x,1:4);
         
        elseif row == row_num
            temp = small_dataset(small_dataset(:,1)>=(min_y + ((row-1)*distance_y_10)) & small_dataset(:,1)<=max_y & ...
                small_dataset(:,2)>=(min_x + ((column-1)*distance_x_10)) & small_dataset(:,2)<(min_x + column*distance_x_10),1:4);
       
        elseif column == column_num
            temp = small_dataset(small_dataset(:,1)>=(min_y + ((row-1)*distance_y_10)) & small_dataset(:,1)<(min_y + row*distance_y_10) & ...
                small_dataset(:,2)>=(min_x + ((column-1)*distance_x_10)) & small_dataset(:,2)<=max_x,1:4);
       
        else
            temp = small_dataset(small_dataset(:,1)>=(min_y + ((row-1)*distance_y_10)) & small_dataset(:,1)<(min_y + row*distance_y_10) & ...
                small_dataset(:,2)>=(min_x + ((column-1)*distance_x_10)) & small_dataset(:,2)<(min_x + column*distance_x_10),1:4);
        end
        
        if isempty(temp)
           map_cells{(row-1)*column_num_10 + column} = 0;
        else
           map_cells{(row-1)*column_num_10 + column} = temp;
           strength = mean(temp(:,3));
           if strength >= -85
               energy_consumption(row,column) = 1;
           elseif strength >= -95
               energy_consumption(row,column) = 2;
           else
               energy_consumption(row,column) = 3;
           end
        end
    end
end

figure(1);
imagesc(energy_consumption)
colorbar();