#include "JoystickSDL.h"

#include "QGCApplication.h"

#include <QQmlEngine>

JoystickSDL::JoystickSDL(const QString& name, int axisCount, int buttonCount, int index, MultiVehicleManager* multiVehicleManager)
    : Joystick(name,axisCount,buttonCount,multiVehicleManager)
    , _index(index)
{
}

QMap<QString, Joystick*> JoystickSDL::discover(MultiVehicleManager* _multiVehicleManager) {
    static QMap<QString, Joystick*> ret;

    if (SDL_InitSubSystem(SDL_INIT_JOYSTICK | SDL_INIT_NOPARACHUTE) < 0) {
        qWarning() << "Couldn't initialize SimpleDirectMediaLayer:" << SDL_GetError();
        return ret;
    }

    // Load available joysticks

    qCDebug(JoystickLog) << "Available joysticks";

    for (int i=0; i<SDL_NumJoysticks(); i++) {
        QString name = SDL_JoystickName(i);

        if (!ret.contains(name)) {
            int axisCount, buttonCount;

            SDL_Joystick* sdlJoystick = SDL_JoystickOpen(i);
            axisCount = SDL_JoystickNumAxes(sdlJoystick);
            buttonCount = SDL_JoystickNumButtons(sdlJoystick);
            SDL_JoystickClose(sdlJoystick);

            qCDebug(JoystickLog) << "\t" << name << "axes:" << axisCount << "buttons:" << buttonCount;
            ret[name] = new JoystickSDL(name, axisCount, buttonCount, i, _multiVehicleManager);
        } else {
            qCDebug(JoystickLog) << "\tSkipping duplicate" << name;
        }
    }
    return ret;
}

bool JoystickSDL::open(void) {
    sdlJoystick = SDL_JoystickOpen(_index);

    if (!sdlJoystick) {
	qCWarning(JoystickLog) << "SDL_JoystickOpen failed:" << SDL_GetError();
	return false;
    }

    return true;
}

void JoystickSDL::close(void) {
    SDL_JoystickClose(sdlJoystick);
}

bool JoystickSDL::update(void)
{
    SDL_JoystickUpdate();
    return true;
}

bool JoystickSDL::getButton(int i) {
    return !!SDL_JoystickGetButton(sdlJoystick, i);
}

int JoystickSDL::getAxis(int i) {
    return SDL_JoystickGetAxis(sdlJoystick, i);
}