A Sensor Data Fusion Algorithm for Human Motion Estimation