linux-imx

// SPDX-License-Identifier: GPL-2.0

/*

 * R-Car Gen3 Clock Pulse Generator

 *

 * Copyright (C) 2015-2018 Glider bvba

 *

 * Based on clk-rcar-gen3.c

 *

 * Copyright (C) 2015 Renesas Electronics Corp.

 */

​

#include <linux/bug.h>

#include <linux/bitfield.h>

#include <linux/clk.h>

#include <linux/clk-provider.h>

#include <linux/device.h>

#include <linux/err.h>

#include <linux/init.h>

#include <linux/io.h>

#include <linux/pm.h>

#include <linux/slab.h>

#include <linux/sys_soc.h>

​

#include "renesas-cpg-mssr.h"

#include "rcar-gen3-cpg.h"

​

#define CPG_PLL0CR      0x00d8

#define CPG_PLL2CR      0x002c

#define CPG_PLL4CR      0x01f4

​

#define CPG_RCKCR_CKSEL BIT(15) /* RCLK Clock Source Select */

​

static spinlock_t cpg_lock;

​

static void cpg_reg_modify(void __iomem *reg, u32 clear, u32 set)

{

    unsigned long flags;

    u32 val;

​

    spin_lock_irqsave(&cpg_lock, flags);

    val = readl(reg);

    val &= ~clear;

    val |= set;

    writel(val, reg);

    spin_unlock_irqrestore(&cpg_lock, flags);

};

​

struct cpg_simple_notifier {

    struct notifier_block nb;

    void __iomem *reg;

    u32 saved;

};

​

static int cpg_simple_notifier_call(struct notifier_block *nb,

                    unsigned long action, void *data)

{

    struct cpg_simple_notifier *csn =

        container_of(nb, struct cpg_simple_notifier, nb);

​

    switch (action) {

    case PM_EVENT_SUSPEND:

        csn->saved = readl(csn->reg);

        return NOTIFY_OK;