QRetroSensors.cpp

#include "QRetroSensors.h"

QRetroSensors::QRetroSensors()
{
  /* Ignore force of gravity */
#if QRETRO_HAVE_SENSORS
  m_AccelerometerSensor.setAccelerationMode(QAccelerometer::User);
#endif
}

bool QRetroSensors::setState(unsigned port, retro_sensor_action action,
  unsigned rate)
{
  if (port)
    return false;
  else
  {
    switch (action)
    {
    case RETRO_SENSOR_ACCELEROMETER_ENABLE:
      m_AccelerometerEnabled = true;
      m_AccelerometerRate = rate;
#if QRETRO_HAVE_SENSORS
      m_AccelerometerSensor.setDataRate(static_cast<int>(rate));
      m_AccelerometerSensor.start();
#endif
      break;
    case RETRO_SENSOR_ACCELEROMETER_DISABLE:
      m_AccelerometerEnabled = false;
#if QRETRO_HAVE_SENSORS
      m_AccelerometerSensor.stop();
#endif
      break;
    case RETRO_SENSOR_GYROSCOPE_ENABLE:
      m_GyroscopeEnabled = true;
      m_GyroscopeRate = rate;
#if QRETRO_HAVE_SENSORS
      m_GyroscopeSensor.setDataRate(static_cast<int>(rate));
      m_GyroscopeSensor.start();
#endif
      break;
    case RETRO_SENSOR_GYROSCOPE_DISABLE:
      m_GyroscopeEnabled = false;
#if QRETRO_HAVE_SENSORS
      m_GyroscopeSensor.stop();
#endif
      break;
    case RETRO_SENSOR_ILLUMINANCE_ENABLE:
      m_IlluminanceEnabled = true;
      m_IlluminanceRate = rate;
#if QRETRO_HAVE_SENSORS
      m_IlluminanceSensor.setDataRate(static_cast<int>(rate));
      m_IlluminanceSensor.start();
#endif
      break;
    case RETRO_SENSOR_ILLUMINANCE_DISABLE:
      m_IlluminanceEnabled = false;
#if QRETRO_HAVE_SENSORS
      m_IlluminanceSensor.stop();
#endif
      break;
    default:
      return false;
    }

    return true;
  }
}

float QRetroSensors::getInput(unsigned port, unsigned id)
{
  if (port)
    return 0;
  else
  {
#if QRETRO_HAVE_SENSORS
    switch (id)
    {
    case RETRO_SENSOR_ACCELEROMETER_X:
      return m_AccelerometerEnabled ?
        static_cast<float>(m_AccelerometerSensor.reading()->x()) : 0;
    case RETRO_SENSOR_ACCELEROMETER_Y:
      return m_AccelerometerEnabled ?
        static_cast<float>(m_AccelerometerSensor.reading()->y()) : 0;
    case RETRO_SENSOR_ACCELEROMETER_Z:
      return m_AccelerometerEnabled ?
        static_cast<float>(m_AccelerometerSensor.reading()->z()) : 0;
    case RETRO_SENSOR_GYROSCOPE_X:
      return m_GyroscopeEnabled ?
        static_cast<float>(m_GyroscopeSensor.reading()->x()) : 0;
    case RETRO_SENSOR_GYROSCOPE_Y:
      return m_GyroscopeEnabled ?
        static_cast<float>(m_GyroscopeSensor.reading()->y()) : 0;
    case RETRO_SENSOR_GYROSCOPE_Z:
      return m_GyroscopeEnabled ?
        static_cast<float>(m_GyroscopeSensor.reading()->z()) : 0;
    case RETRO_SENSOR_ILLUMINANCE:
      if (m_IlluminanceEnabled)
      {
        switch (m_IlluminanceSensor.reading()->lightLevel())
        {
        case QAmbientLightReading::Dark:
          return 1/5;
        case QAmbientLightReading::Twilight:
          return 2/5;
        case QAmbientLightReading::Light:
          return 3/5;
        case QAmbientLightReading::Bright:
          return 4/5;
        case QAmbientLightReading::Sunny:
          return 5/5;
        default:
          return 0;
        }
      }
      else
        return 0;
    default:
      return 0;
    }
#else
    return 0;
#endif
  }
}