Smartdashboard added and while loop removed

Added smart dashboard support, so we can change the filter values
without recompiling. Removed the while loop to preserve crio flash
memory
2nd smart dashboard update

added saturation and value to smart dashboard
Merge pull request #1 from C-Elegans/master

Smartdashboard and while loop update