Separated fw_pos_control_l1 into a header file and a functionality file (first pass) ; fixed some spacing issues.