Added SmartDashboard commands and updated Smart Dashboard.