* Refactored HLA

* Refactors

* Refactored broken tests

* Cleaned up duplicated code

* Cleaned up duplicated code

* Added TotalOrderPlanner

* Linearize helper function

* Added tests for TotalOrderPlanner

* Readd sussman anomaly test