Smartdashboard vision plugin

Kinda working - Jeremy