Fixed case where there is only one local max Switched some stuff to the utils functions
Fixed case where there is only one local max
Switched some stuff to the utils functions

JNeiger/robocup-software,JNeiger/robocup-software,JNeiger/robocup-software,RoboJackets/robocup-software,JNeiger/robocup-software,RoboJackets/robocup-software,RoboJackets/robocup-software,JNeiger/robocup-software,RoboJackets/robocup-software