Joint trajectory improved debugging

Because of the realtime constraints and lack of output information, debugging the joint trajectory controller is fairly difficult. This PR adds a little bit better output messages as well as an optional 'verbose' mode that you can disable via the code to get more feedback on why trajectories are failing. Does not change the performance for any current robots (unless you enable verbose in which case the realtime loop is not guaranteed).