linux-imx

// SPDX-License-Identifier: GPL-2.0

/*

 * System Control and Management Interface (SCMI) Power Protocol

 *

 * Copyright (C) 2018 ARM Ltd.

 */

​

#include "common.h"

​

enum scmi_power_protocol_cmd {

    POWER_DOMAIN_ATTRIBUTES = 0x3,

    POWER_STATE_SET = 0x4,

    POWER_STATE_GET = 0x5,

    POWER_STATE_NOTIFY = 0x6,

};

​

struct scmi_msg_resp_power_attributes {

    __le16 num_domains;

    __le16 reserved;

    __le32 stats_addr_low;

    __le32 stats_addr_high;

    __le32 stats_size;

};

​

struct scmi_msg_resp_power_domain_attributes {

    __le32 flags;

#define SUPPORTS_STATE_SET_NOTIFY(x)    ((x) & BIT(31))

#define SUPPORTS_STATE_SET_ASYNC(x) ((x) & BIT(30))

#define SUPPORTS_STATE_SET_SYNC(x)  ((x) & BIT(29))

        u8 name[SCMI_MAX_STR_SIZE];

};

​

struct scmi_power_set_state {

    __le32 flags;

#define STATE_SET_ASYNC     BIT(0)

    __le32 domain;

    __le32 state;

};

​

struct scmi_power_state_notify {

    __le32 domain;

    __le32 notify_enable;

};

​

struct power_dom_info {

    bool state_set_sync;

    bool state_set_async;

    bool state_set_notify;

    char name[SCMI_MAX_STR_SIZE];

};

​

struct scmi_power_info {

    int num_domains;

    u64 stats_addr;

    u32 stats_size;

    struct power_dom_info *dom_info;

};

​

static int scmi_power_attributes_get(const struct scmi_handle *handle,

                     struct scmi_power_info *pi)

{

    int ret;

    struct scmi_xfer *t;

    struct scmi_msg_resp_power_attributes *attr;

​

    ret = scmi_xfer_get_init(handle, PROTOCOL_ATTRIBUTES,

                 SCMI_PROTOCOL_POWER, 0, sizeof(*attr), &t);

    if (ret)

        return ret;

​

    attr = t->rx.buf;

​

    ret = scmi_do_xfer(handle, t);

    if (!ret) {

        pi->num_domains = le16_to_cpu(attr->num_domains);

        pi->stats_addr = le32_to_cpu(attr->stats_addr_low) |

                (u64)le32_to_cpu(attr->stats_addr_high) << 32;

        pi->stats_size = le32_to_cpu(attr->stats_size);

    }

​

    scmi_xfer_put(handle, t);

    return ret;

}

​

static int

scmi_power_domain_attributes_get(const struct scmi_handle *handle, u32 domain,

                 struct power_dom_info *dom_info)

{

    int ret;

    struct scmi_xfer *t;

    struct scmi_msg_resp_power_domain_attributes *attr;

​