Removing leg_ctrl, going to use separate branches to bring each code moudle into FreeRTOS format.