A little progress

Haven't had a whole lot of time to work on this lately... I managed to rewrite and reorganize most of the code, it's a lot cleaner now, but unfortunately about 10% slower... I also added some nice logging functions which should make debugging a lot easier. Still haven't gotten around to hooking up the video yet, hopefully I'll be able to do that soon.