Major rework to implement more PS2 commands
Updated controller initialisation to force digital mode
Reconfigure the controller at fixed intervals (hotplug)
Added rumble motors control
Made the PS2 library leave microcontroller time for other operations