Improved initial guess stuff. Added visualizer for trivial system.
New strategy: alternate between capturabilityDiscreteBarrier and capturabilityContinuousBarrier (to be developed).