This is an incorrect implementation https://github.com/NTNU-MCS/TMR4243_LAB/blob/c03efd0f9717b1e830fd9212ed3c19b133d1f0e4/template_joystick_control/template_joystick_control/joystick_control_node.py#L120 Only works for $u \in \mathbb{R}^5$ and applies only for _simple_ task.
This is an incorrect implementation
TMR4243_LAB/template_joystick_control/template_joystick_control/joystick_control_node.py
Line 120 in c03efd0
Only works for$u \in \mathbb{R}^5$ and applies only for simple task.