Used the driver from Simone201, adapted for the 5 steps on our mali revision.
Also fixed a compilation error, crdits to simone201