linux-imx

// SPDX-License-Identifier: GPL-2.0

/*

 *  H8S TPU Driver

 *

 *  Copyright 2015 Yoshinori Sato <ysato@users.sourcefoge.jp>

 *

 */

​

#include <linux/errno.h>

#include <linux/kernel.h>

#include <linux/init.h>

#include <linux/clocksource.h>

#include <linux/clk.h>

#include <linux/io.h>

#include <linux/of.h>

#include <linux/of_address.h>

#include <linux/of_irq.h>

​

#define TCR 0x0

#define TSR 0x5

#define TCNT    0x6

​

#define TCFV    0x10

​

struct tpu_priv {

    struct clocksource cs;

    void __iomem *mapbase1;

    void __iomem *mapbase2;

    raw_spinlock_t lock;

    unsigned int cs_enabled;

};

​

static inline unsigned long read_tcnt32(struct tpu_priv *p)

{

    unsigned long tcnt;

​

    tcnt = ioread16be(p->mapbase1 + TCNT) << 16;

    tcnt |= ioread16be(p->mapbase2 + TCNT);

    return tcnt;

}

​

static int tpu_get_counter(struct tpu_priv *p, unsigned long long *val)

{

    unsigned long v1, v2, v3;

    int o1, o2;

​

    o1 = ioread8(p->mapbase1 + TSR) & TCFV;

​

    /* Make sure the timer value is stable. Stolen from acpi_pm.c */

    do {

        o2 = o1;

        v1 = read_tcnt32(p);

        v2 = read_tcnt32(p);

        v3 = read_tcnt32(p);

        o1 = ioread8(p->mapbase1 + TSR) & TCFV;

    } while (unlikely((o1 != o2) || (v1 > v2 && v1 < v3)

              || (v2 > v3 && v2 < v1) || (v3 > v1 && v3 < v2)));

​

    *val = v2;

    return o1;

}

​

static inline struct tpu_priv *cs_to_priv(struct clocksource *cs)