Bugfixes and updates after testing some more
Added test auto program