Pilot updated. PID loop and hovering with sensor works to an  extent.