AC_PID: update example sketch to test AC_HELI_PID