Added inverse/forward motion model functions