Add a function to compute the total force and normal torque at the CoP of each foot