Added variables for target speed and altitude in tracking mode.

Also tried to add target altitude in FBWB mode. Not sure how this will
work.