Firmware for BPS Senior Design Team 2015