Copter WPNav: Leonard's improved speed fix

Also pass in althold gain from main code
Copter: pass alt hold gain to WP_Nav library
Copter: remove unused cli wp report