Recently I have been experimenting with model based control to improve our shooter. After attempting to implement it as a command and simulating the code, my plot shows an odd output. Any ideas why this might be?
Function in subsystem:
Command:
Here is my output on the plot (very messed up):