Recursive forward dynamics for two robot arms in a closed chain based on Kalman filtering and Bryson-Frazier smoothing