Fixed set angular velocity
Fixed inverse