Homework 5
Modified main.c to work with David's board