Replaced exp by expm - whoops!