cube

Dependencies:   BNO055_fusion_tom FastPWM mbed

Refactor

I made a struct that we can populate with the parameters for the different balancing configurations. This way we don't have to write separate control loops and update loops for each of the edges we balance on. We just need to detect which edge we are trying to balance on and set the currentConfiguration to that set of parameters.