[trajoptlib] Const-qualify solution passed to callback (#1105)

[trajoptlib] Const-qualify solution passed to callback (#1105) #2226