Here is a simple toolbox for solving switched optimal control problems. The code supports the paper with J. Daafouz and D. Henrion on switched systems.
The toolbox is as user-friendly and minimal as possible. Note that you can solve regular optimal control problems as well, by considering them as switched systems with a single mode.
Do not hesitate to contact me should you have a problem running the files.
Mathieu Claeys 