fw_pos_control_l1: use new mathlib