Add current test code for the AndyMark motors

It's pretty horrifying, and I pity anyone who has to use
it (including my future self), but here it is for
completeness.