The applications-linux/scl_example_ctrl application covers basic operational space control. Please do take a look.

You can copy that using a script we provided, which creates a new git branch for you with a custom controller implementation that you can modify for your own use:

$ cd applications-linux
$ sh create_new_ctrl.sh <your_name_all_small_letters> <your_git_branch_name>