using deepcopy with current_pos message and adding on tf values to obtain fiducial_pos