Removed I component of loiter PID loop. This makes for Cycle 1 demo able code.