Finished reverese dynamics and added exploreStates