Added distance control for PIDs

Altitude, Distance Front, Distance Left, Distance Right, Angle