logiops/src/logid/backend/hidpp20/Feature.cpp

/*
 * Copyright 2019-2020 PixlOne
 *
 * This program is free software: you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation, either version 3 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program.  If not, see <http://www.gnu.org/licenses/>.
 *
 */

#include "Error.h"
#include "Feature.h"
#include "feature_defs.h"
#include "features/Root.h"

using namespace logid::backend::hidpp20;

const char* UnsupportedFeature::what() const noexcept
{
    return "Unsupported feature";
}

uint16_t UnsupportedFeature::code() const noexcept
{
    return _f_id;
}

std::vector<uint8_t> Feature::callFunction(uint8_t function_id, std::vector<uint8_t>& params)
{
    return _device->callFunction(_index, function_id, params);
}

Feature::Feature(Device* dev, uint16_t _id) : _device (dev)
{
    _index = hidpp20::FeatureID::ROOT;

    if(_id)
    {
        std::vector<uint8_t> getFunc_req(2);
        getFunc_req[0] = (_id >> 8) & 0xff;
        getFunc_req[1] = _id & 0xff;

        try {
            auto getFunc_resp = this->callFunction(Root::GetFeature,
                    getFunc_req);
            _index = getFunc_resp[0];
        } catch(Error& e) {
            if(e.code() == Error::InvalidFeatureIndex)
                throw UnsupportedFeature(_id);
            throw e;
        }

        // 0 if not found
        if(!_index)
            throw UnsupportedFeature(_id);
    }
}

uint8_t Feature::featureIndex()
{
    return _index;
}