Matlab toys for simulating optimal and underactuated control systems