updated todo
updated todo
whereami macro
init_pose was adding redundant (if not inaccurate) path
updated todo
updated todo