This is the working branch from my desktop, that drives the cubes well with no bugs...