Smartdashboard and while loop update

Added smartdashboard support for the threshold operation so we don't need to recompile to change the values. Removed the while loop to preserver the crio flash memory