linux-imx

/*

 * Copyright (c) 2015 Pengutronix, Steffen Trumtrar <kernel@pengutronix.de>

 * Copyright (c) 2017 Pengutronix, Oleksij Rempel <kernel@pengutronix.de>

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License version 2

 * as published by the Free Software Foundation.

 */

​

#include <linux/mfd/syscon.h>

#include <linux/module.h>

#include <linux/nvmem-provider.h>

#include <linux/of_device.h>

#include <linux/regmap.h>

​

#define IMX6Q_SNVS_HPLR     0x00

#define IMX6Q_SNVS_LPLR     0x34

#define IMX6Q_SNVS_LPGPR    0x68

​

#define IMX7D_SNVS_HPLR     0x00

#define IMX7D_SNVS_LPLR     0x34

#define IMX7D_SNVS_LPGPR    0x90

​

#define IMX_GPR_SL      BIT(5)

#define IMX_GPR_HL      BIT(5)

​

struct snvs_lpgpr_cfg {

    int offset;

    int offset_hplr;

    int offset_lplr;

    int size;

};

​

struct snvs_lpgpr_priv {

    struct device_d         *dev;

    struct regmap           *regmap;

    struct nvmem_config     cfg;

    const struct snvs_lpgpr_cfg *dcfg;

};

​

static const struct snvs_lpgpr_cfg snvs_lpgpr_cfg_imx6q = {

    .offset     = IMX6Q_SNVS_LPGPR,

    .offset_hplr    = IMX6Q_SNVS_HPLR,

    .offset_lplr    = IMX6Q_SNVS_LPLR,

    .size       = 4,

};

​

static const struct snvs_lpgpr_cfg snvs_lpgpr_cfg_imx7d = {

    .offset     = IMX7D_SNVS_LPGPR,

    .offset_hplr    = IMX7D_SNVS_HPLR,

    .offset_lplr    = IMX7D_SNVS_LPLR,

    .size       = 16,

};

​

static int snvs_lpgpr_write(void *context, unsigned int offset, void *val,

                size_t bytes)

{

    struct snvs_lpgpr_priv *priv = context;

    const struct snvs_lpgpr_cfg *dcfg = priv->dcfg;

    unsigned int lock_reg;

    int ret;

​

    ret = regmap_read(priv->regmap, dcfg->offset_hplr, &lock_reg);