A start to actually implementing the firmware. It doesn't work yet though.