Add path finder implementation

strategy_handler_path_finder is function which manage the position of
the robot.
It uses the move function available in propulsion.

remove action_print_file calling.

TODO: write path finder functions in other file.