Initialize the position of the marker to the frame if ~initial_reference_frame is specified

initialize the pose of the marker to the `~initial_reference_frame`. If it is not specified, 
no initialization will be conducted.