Changed imgpoints flow to PointStamped