Development of Kalman Filter based two-port Body Force Observer for the Flexible Joint: Design and Experiments