position_setpoint_triplet refactoring finished
px4fmu-v2_test makefile fixed, CMSIS added