Cleaned up header comments in Contained_RBTree.h
Wrote first draft of controller state machine