Split TEST macros into TestTools files
added files I left out of last commit
Fixed a few warnings and merged changes from the FrameScheduler. Catch now works properly in real time.