Added RC control but not yet Check_safety_init()