Copter: move drift thr assist to separate function

no changes in functionality.