Fixed bug in 4 stage ESDIRK