function [newPoint] = warpPoint(point,R,t) point = [point,1]; tmp = R * point'; tmp = tmp / tmp(3); newPoint = tmp + t'; newPoint = newPoint(1:2); end