Please add c++ examples using the c++ api

[athultr1997]

Currently there are only tutorials for trajoptpy in the documentation. It will be very helpful if you could add a few examples based on the C++ api making use of sco and trajopt.

[EdsterG]

Lots of examples in the unit tests, specifically, trajopt/src/trajopt/test/planning-unit.cpp.