Do storemotors() and readmotors() execute once every long long loop (26.2 ms) or every short loop? I'm still a bit confused to those and it would seem like and awful waste of space to do it more than every 26.2ms.
But either way, does this ever have ideas brewing in my head.
EDIT: misunderstanding about the loops, got it all sorted out now.