Some bugs fixed. Stabilization now works better. Code for calculating S matrices by Matsushita method added, but does not work yet.