First test program running with display!

Fix for STO operation, many other bug fixes.