Series of bugfixes, improvements and optimisations

USB stack was improved to help support for older USB devices.
Some additional firmware size optimisations. It is getting more difficult to keep firmware at the maximum size.