Add selftest mode

[RyanMeulenkamp]

Other than the three modes it has already, add a selftest mode in which it loops all functionalities. That way we could determine if hardware is working correctly. There is something like this in the codebase but it is not converted to work with the box fully assembled. Also, it's not reachable using the buttons.