Created PI object specific to Loiter over-control.

Also, renamed all functions in order to allows sensible addition of side sonar control.
Create Side Sonar controller
Change the sonar function switch from Ch6 to Ch7.