Not tested version of the lib that should work
Should work now, so now i just need the hardware...