system/dev/light/gpio-light/gpio-light.cpp

// Copyright 2017 The Fuchsia Authors. All rights reserved.
// Use of this source code is governed by a BSD-style license that can be
// found in the LICENSE file.

#include "gpio-light.h"

#include <assert.h>
#include <stdint.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <threads.h>
#include <unistd.h>

#include <memory>

#include <ddk/binding.h>
#include <ddk/debug.h>
#include <ddk/platform-defs.h>
#include <ddktl/protocol/platform/device.h>
#include <fbl/unique_ptr.h>

#include <zircon/process.h>
#include <zircon/syscalls.h>
#include <zircon/assert.h>

namespace gpio_light {

zx_status_t GpioLight::MsgGetName(fidl_txn_t* txn) {
    const char* name = "gpio";
    return fuchsia_hardware_light_LightGetName_reply(txn, name, strlen(name) + 1);
}

zx_status_t GpioLight::MsgGetCount(fidl_txn_t* txn) {
    return fuchsia_hardware_light_LightGetCount_reply(txn, gpio_count_);
}

zx_status_t GpioLight::MsgHasCapability(uint32_t index,
                                        fuchsia_hardware_light_Capability capability,
                                        fidl_txn_t* txn) {
    if (index >= gpio_count_) {
        return fuchsia_hardware_light_LightHasCapability_reply(txn, ZX_ERR_OUT_OF_RANGE, false);
    }
    return fuchsia_hardware_light_LightHasCapability_reply(txn, ZX_OK, false);
}

zx_status_t GpioLight::MsgGetSimpleValue(uint32_t index, fidl_txn_t* txn) {
    if (index >= gpio_count_) {
        return fuchsia_hardware_light_LightGetSimpleValue_reply(txn, ZX_ERR_OUT_OF_RANGE, 0);
    }

    uint8_t value;
    auto status = gpios_[index].Read(&value);
    return fuchsia_hardware_light_LightGetSimpleValue_reply(txn, status, value);
}

zx_status_t GpioLight::MsgSetSimpleValue(uint32_t index, uint8_t value, fidl_txn_t* txn) {
    if (index >= gpio_count_) {
        return fuchsia_hardware_light_LightSetSimpleValue_reply(txn, ZX_ERR_OUT_OF_RANGE);
    }

    auto status = gpios_[index].Write(value);
    return fuchsia_hardware_light_LightSetSimpleValue_reply(txn, status);
}

zx_status_t GpioLight::MsgGetRgbValue(uint32_t index, fidl_txn_t* txn) {
    fuchsia_hardware_light_Rgb rgb = {};
    return fuchsia_hardware_light_LightGetRgbValue_reply(txn, ZX_ERR_NOT_SUPPORTED, &rgb);
}

zx_status_t GpioLight::MsgSetRgbValue(uint32_t index, const fuchsia_hardware_light_Rgb* value,
                                      fidl_txn_t* txn) {

    return fuchsia_hardware_light_LightSetRgbValue_reply(txn, ZX_ERR_NOT_SUPPORTED);
}

static fuchsia_hardware_light_Light_ops_t fidl_ops = {
    .GetName = [](void* ctx, fidl_txn_t* txn) {
                return reinterpret_cast<GpioLight*>(ctx)->MsgGetName(txn); },
    .GetCount = [](void* ctx, fidl_txn_t* txn) {
                return reinterpret_cast<GpioLight*>(ctx)->MsgGetCount(txn); },
    .HasCapability = [](void* ctx, uint32_t index, fuchsia_hardware_light_Capability capability,
                        fidl_txn_t* txn) {
                return reinterpret_cast<GpioLight*>(ctx)->MsgHasCapability(index, capability, txn); },
    .GetSimpleValue = [](void* ctx, uint32_t index, fidl_txn_t* txn) {
                return reinterpret_cast<GpioLight*>(ctx)->MsgGetSimpleValue(index, txn); },
    .SetSimpleValue = [](void* ctx, uint32_t index, uint8_t value, fidl_txn_t* txn) {
                return reinterpret_cast<GpioLight*>(ctx)->MsgSetSimpleValue(index, value, txn); },
    .GetRgbValue = [](void* ctx, uint32_t index, fidl_txn_t* txn) {
                return reinterpret_cast<GpioLight*>(ctx)->MsgGetRgbValue(index, txn); },
    .SetRgbValue = [](void* ctx, uint32_t index, const fuchsia_hardware_light_Rgb* value,
                      fidl_txn_t* txn) {
                return reinterpret_cast<GpioLight*>(ctx)->MsgSetRgbValue(index, value, txn); },
};

zx_status_t GpioLight::DdkMessage(fidl_msg_t* msg, fidl_txn_t* txn) {
    return fuchsia_hardware_light_Light_dispatch(this, txn, msg, &fidl_ops);
}

void GpioLight::DdkRelease() {
    delete this;
}

zx_status_t GpioLight::Create(void* ctx, zx_device_t* parent) {
    fbl::AllocChecker ac;
    auto dev = std::unique_ptr<GpioLight>(new (&ac) GpioLight(parent));
    if (!ac.check()) {
        return ZX_ERR_NO_MEMORY;
    }

    auto status = dev->Init();
    if (status != ZX_OK) {
        return status;
    }

    // devmgr is now in charge of the device.
    __UNUSED auto* dummy = dev.release();
    return ZX_OK;
}

zx_status_t GpioLight::Init() {
    ddk::PDevProtocolClient pdev(parent());
    if (!pdev.is_valid()) {
        return ZX_ERR_NOT_SUPPORTED;
    }

    pdev_device_info_t  info;
    if (pdev.GetDeviceInfo(&info) != ZX_OK) {
        return ZX_ERR_NOT_SUPPORTED;
    }
    gpio_count_ = info.gpio_count;

    fbl::AllocChecker ac;
    auto* gpios = new (&ac) ddk::GpioProtocolClient[info.gpio_count];
    if (!ac.check()) {
        return ZX_ERR_NO_MEMORY;
    }
    gpios_.reset(gpios, info.gpio_count);

    for (uint32_t i = 0; i < info.gpio_count; i++) {
        auto* gpio = &gpios_[i];
        size_t actual;
        auto status = pdev.GetProtocol(ZX_PROTOCOL_GPIO, i, gpio, sizeof(*gpio), &actual);
        if (status != ZX_OK) {
            return status;
        }
        status = gpio->ConfigOut(0);
        if (status != ZX_OK) {
            zxlogf(ERROR, "gpio-light: ConfigOut failed for gpio %u\n", i);
            return status;
        }
    }

    return DdkAdd("gpio-light", DEVICE_ADD_NON_BINDABLE);
}

static zx_driver_ops_t driver_ops = [](){
    zx_driver_ops_t ops;
    ops.version = DRIVER_OPS_VERSION;
    ops.bind = GpioLight::Create;
    return ops;
}();

} // namespace gpio_light

ZIRCON_DRIVER_BEGIN(gpio_light, gpio_light::driver_ops, "zircon", "0.1", 4)
    BI_ABORT_IF(NE, BIND_PROTOCOL, ZX_PROTOCOL_PDEV),
    BI_ABORT_IF(NE, BIND_PLATFORM_DEV_VID, PDEV_VID_GENERIC),
    BI_ABORT_IF(NE, BIND_PLATFORM_DEV_PID, PDEV_PID_GENERIC),
    BI_MATCH_IF(EQ, BIND_PLATFORM_DEV_DID, PDEV_DID_GPIO_LIGHT),
ZIRCON_DRIVER_END(gpio_light)