linux-imx

// SPDX-License-Identifier: GPL-2.0-only

/*

 * Copyright (c) 2016-2017, NVIDIA CORPORATION. All rights reserved

 */

​

#include <linux/of.h>

#include <linux/platform_device.h>

#include <linux/pm_domain.h>

#include <linux/slab.h>

#include <linux/version.h>

​

#include <soc/tegra/bpmp.h>

#include <soc/tegra/bpmp-abi.h>

​

struct tegra_powergate_info {

    unsigned int id;

    char *name;

};

​

struct tegra_powergate {

    struct generic_pm_domain genpd;

    struct tegra_bpmp *bpmp;

    unsigned int id;

};

​

static inline struct tegra_powergate *

to_tegra_powergate(struct generic_pm_domain *genpd)

{

    return container_of(genpd, struct tegra_powergate, genpd);

}

​

static int tegra_bpmp_powergate_set_state(struct tegra_bpmp *bpmp,

                      unsigned int id, u32 state)

{

    struct mrq_pg_request request;

    struct tegra_bpmp_message msg;

    int err;

​

    memset(&request, 0, sizeof(request));

    request.cmd = CMD_PG_SET_STATE;

    request.id = id;

    request.set_state.state = state;

​

    memset(&msg, 0, sizeof(msg));

    msg.mrq = MRQ_PG;

    msg.tx.data = &request;

    msg.tx.size = sizeof(request);

​

    err = tegra_bpmp_transfer(bpmp, &msg);

    if (err < 0)

        return err;

    else if (msg.rx.ret < 0)

        return -EINVAL;

​

    return 0;

}

​

static int tegra_bpmp_powergate_get_state(struct tegra_bpmp *bpmp,

                      unsigned int id)

{

    struct mrq_pg_response response;

    struct mrq_pg_request request;

    struct tegra_bpmp_message msg;

    int err;

​

    memset(&request, 0, sizeof(request));

    request.cmd = CMD_PG_GET_STATE;

    request.id = id;

​

    memset(&response, 0, sizeof(response));

​

    memset(&msg, 0, sizeof(msg));

    msg.mrq = MRQ_PG;

    msg.tx.data = &request;

    msg.tx.size = sizeof(request);

    msg.rx.data = &response;

    msg.rx.size = sizeof(response);

​

    err = tegra_bpmp_transfer(bpmp, &msg);

    if (err < 0)

        return PG_STATE_OFF;

    else if (msg.rx.ret < 0)

        return -EINVAL;

​

    return response.get_state.state;

}

​

static int tegra_bpmp_powergate_get_max_id(struct tegra_bpmp *bpmp)

{

    struct mrq_pg_response response;

    struct mrq_pg_request request;

    struct tegra_bpmp_message msg;