Started adding hardware code.  Includes inits and set_teams for MAX6953