Fix ContactTask and add Bilateral contact support.
addTask add a task only if the task is not already in the tasks_ vector.
removeTask don't remove a task if the task is not in the tasks_ vector.