Fixed HIL mode switching, HIL works