Initial commit. Still have to test this code once the hardware is ready.