An attempt to fix some of the remaining NAVA Firmware bugs and add some features I wanted for my own use.