6D pose and twist estimation using a multiplicative error state Kalman filter with a ROS interface.