Initialize pose to identity