Real-Time ESFP: Estimating, Smoothing, Filtering, and Pose-Mapping