mc_pos_control: refactor, move landed thrust reduction into function

and make it use matrix library for flight task compatibility

# Conflicts:
#	src/modules/mc_pos_control/mc_pos_control_main.cpp