Finish basic functionality of beacon board firmware