I liked your project; I think it has potential. If I have the time, I might try rewriting some parts in C, but since I don't have the testing hardware, I'll submit the changes to you via a fork.