added set_idle_control_mode in init func. (workaround for exit from fault status)