Sensors/WorkhorseNavigator: fixed segmentation fault while reading position and orientation.