void Adafruit_LSM9DS0::getSensor(sensor_t *accel, sensor_t *mag,
sensor_t *gyro, sensor_t *temp )
{
/* Update appropriate sensor metadata. */
if (accel) getAccelSensor(accel);
if (gyro) getGyroSensor(gyro);
}
void Main::TeleopPeriodic()
{
Scheduler::GetInstance()->Run();
//double voltage = getShooter().GetVoltage();
//SmartDashboard::PutNumber("Voltage", voltage);
//double speed = getShooter().GetCurrent();
//SmartDashboard::PutNumber("Current", speed);
double opticalOne = getOpticalSensors().GetSensorFront();
double opticalTwo = getOpticalSensors().GetSensorBack();
SmartDashboard::PutNumber("OpticalFront", opticalOne);
SmartDashboard::PutNumber("OpticalBack", opticalTwo);
double ultrasonic = getUltrasonicSensor().GetRangeInInches();
SmartDashboard::PutNumber("Ultrasonic", ultrasonic);
getGyroSensor().GetGyro();
m_drive.PutEncoderValues();
double intakeNumber = getIntake().GetPosition();
SmartDashboard::PutNumber("Intake Encoder", intakeNumber);
}