Implemented fmi_dostep for FMU 2.0