trackRigid: add rigid object alignment function (not working well for tracking)