Attitude: Level attitude more smoothly during arming

Previously accelKp was set to 1 for the entire arming period.  This
is overkill and we can use a decayed schedule for a smooth
convergence.