Updated module to correctly use the force smoother
Modified controller. Now it is the same as the Codyco demo matlab controller”