Added most functionality for solution. Stubbed out hard and soft constraint vio, waiting on albert to change assignment map and still need backtracking