Ego-Pose Estimation and Forecasting as Real-Time PD Control