Fixes #38, #21 and #20. Requires rpi-firmware update.