Working on implementing control initialization

Does not work yet, working on new control initialization and maintenance
algorithm