LFB bug fix, hoist gimbal check, cleanup