Mutliple Changes
1. Modified script to init motor controller
2. Added the right motor drive logic
3. Attempted to optimise the RPM methods to reduce interrupt latency
4. Updated the Firmware to include a SetMotors command for controlling both left and right motors