Added a subscription to range sensors.

The sensors indicate if the desired altitude is free. During the whole
trajectory the uav tries to adjust its altitude as soon as possible.
At the end, when the position is reached, if the altitude has not been
reached and is unattainable, it is set to the closest possible.
iAdded possibility to have no sonar.
Modified features