This was requested. Seems very interesting, definitely will give it a go soon.
Unverified, any cross-checking with the
schematic is welcome :)
**3rd edit alread lol. Moved some stuff around for easier access.**
****Ok, this was clearly a case of premature posting
4th edit.I double checked everything and made some more changes****