Fix threading in FW pos controller