Added proef_algortihm and Field_visualization_2

proef_algortihm contains the code with a*. This will be merged later in
algorithm.py. Field_visualization_2 contains the added sorted_list
function. This will also be merged later. Overall improvement of
sorted_list is from 8 lines to 15 lines on first layer!