Copter: NOT FOR MASTER

Adds high rate debug logging
AC_PosControl: Add spike and noise filter to demanded angles

This has been done to provide a smooth psotion hold when using an optical flow aided EKF which can be noisy.

Signed-off-by: priseborough <p_riseborough@live.com.au>