Add stub init functions for hardware
Cleanup main