printMsg and autonomous fixes

needs testing!