Code running on the PiBot for PiBot capstone