Reworked a little bit more the CascadePID controllers. Also worked on a continuous maximizer, but it seems to work very poorly in competition. Which is weird because I expected it to do better then.