Code to transform features points into world coordinates