updated to changes in sofa trunk
customizable pid in robot controller