Core functionality of high-level motor control logic; renamed testing functions; increased timer resolution; minor fixes here and there
Maximum timer frequency set to 5MHz, though the next matching frequency is 4MHz
Coding style fixes