Great work. First version of algorithm (it does not work correctly but this is the first pace on the moon :D). Added comments and a lot of useful methods and attributes. Correggimi se sbaglio XD