2D inverse dynamics wrapping seems to be working.