TECS: use constant from geo
TECS: warning fixes
fw_pos_control_l1: warning fixes