Refactor Teleop to match new control and task architecture

[linear]

Use current joint servoing implementation

[mustafab0]

@ruthwikdasyam please tag your PR to this issue under Development, to close issue once PR is merged.