SDM pose estimate: now includes t_z
Added normalisation of 2d coords