Closed belgiumkansas closed 5 years ago
This can be easily achieved with the topic_tools packages mux node. There are services for adding mux input as well as switching the active input. This allows the state machine to easily control the mode and add control loop sources.
We need a control MUX in for each of the drive, strafe loops to allow visual servoing. This sits between the control effort output of the loops and the Thruster Allocation Matrix.