It works. Displacement works as expected, but need to improved (only negative when slowly down, so we need to figure out how to account for directions). There is one an error of unknown origin.