Revert "Wait for FRI feedback when switching control mode"

This reverts commit d0981d6629f12d53e603029810ee4bbea001341a
as it introduces hang out in FRI communication
Set Tool #2 (force sensor) in krl script