finished Simbody simulation; Updated on chrono