adding logging to ar servo manager, grabbing head frame from tf