linux-imx

// SPDX-License-Identifier: GPL-2.0

/*

 * Intel(R) Trace Hub Software Trace Hub support

 *

 * Copyright (C) 2014-2015 Intel Corporation.

 */

​

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

​

#include <linux/types.h>

#include <linux/module.h>

#include <linux/device.h>

#include <linux/io.h>

#include <linux/mm.h>

#include <linux/slab.h>

#include <linux/stm.h>

​

#include "intel_th.h"

#include "sth.h"

​

struct sth_device {

    void __iomem    *base;

    void __iomem    *channels;

    phys_addr_t channels_phys;

    struct device   *dev;

    struct stm_data stm;

    unsigned int    sw_nmasters;

};

​

static struct intel_th_channel __iomem *

sth_channel(struct sth_device *sth, unsigned int master, unsigned int channel)

{

    struct intel_th_channel __iomem *sw_map = sth->channels;

​

    return &sw_map[(master - sth->stm.sw_start) * sth->stm.sw_nchannels +

               channel];

}

​

static void sth_iowrite(void __iomem *dest, const unsigned char *payload,

            unsigned int size)

{

    switch (size) {

#ifdef CONFIG_64BIT

    case 8:

        writeq_relaxed(*(u64 *)payload, dest);

        break;

#endif

    case 4:

        writel_relaxed(*(u32 *)payload, dest);

        break;

    case 2:

        writew_relaxed(*(u16 *)payload, dest);

        break;

    case 1:

        writeb_relaxed(*(u8 *)payload, dest);

        break;

    default:

        break;

    }

}

​

static ssize_t notrace sth_stm_packet(struct stm_data *stm_data,

                      unsigned int master,