linux-imx

// SPDX-License-Identifier: GPL-2.0

/*

 * Copyright (c) 2016, Linaro Ltd

 */

​

#include <linux/io.h>

#include <linux/module.h>

#include <linux/of.h>

#include <linux/of_address.h>

#include <linux/interrupt.h>

#include <linux/platform_device.h>

#include <linux/mfd/syscon.h>

#include <linux/slab.h>

#include <linux/rpmsg.h>

#include <linux/idr.h>

#include <linux/circ_buf.h>

#include <linux/soc/qcom/smem.h>

#include <linux/sizes.h>

#include <linux/delay.h>

#include <linux/regmap.h>

#include <linux/workqueue.h>

#include <linux/list.h>

​

#include <linux/rpmsg/qcom_glink.h>

​

#include "qcom_glink_native.h"

​

#define FIFO_FULL_RESERVE 8

#define FIFO_ALIGNMENT 8

#define TX_BLOCKED_CMD_RESERVE 8 /* size of struct read_notif_request */

​

#define SMEM_GLINK_NATIVE_XPRT_DESCRIPTOR   478

#define SMEM_GLINK_NATIVE_XPRT_FIFO_0       479

#define SMEM_GLINK_NATIVE_XPRT_FIFO_1       480

​

struct glink_smem_pipe {

    struct qcom_glink_pipe native;

​

    __le32 *tail;

    __le32 *head;

​

    void *fifo;

​

    int remote_pid;

};

​

#define to_smem_pipe(p) container_of(p, struct glink_smem_pipe, native)

​

static size_t glink_smem_rx_avail(struct qcom_glink_pipe *np)

{

    struct glink_smem_pipe *pipe = to_smem_pipe(np);

    size_t len;

    void *fifo;

    u32 head;

    u32 tail;

​

    if (!pipe->fifo) {

        fifo = qcom_smem_get(pipe->remote_pid,

                     SMEM_GLINK_NATIVE_XPRT_FIFO_1, &len);

        if (IS_ERR(fifo)) {

            pr_err("failed to acquire RX fifo handle: %ld\n",

                   PTR_ERR(fifo));

            return 0;

        }

​

        pipe->fifo = fifo;

        pipe->native.length = len;

    }

​

    head = le32_to_cpu(*pipe->head);

    tail = le32_to_cpu(*pipe->tail);

​

    if (head < tail)

        return pipe->native.length - tail + head;

    else

        return head - tail;

}

​

static void glink_smem_rx_peak(struct qcom_glink_pipe *np,

                   void *data, unsigned int offset, size_t count)

{

    struct glink_smem_pipe *pipe = to_smem_pipe(np);

    size_t len;

    u32 tail;

​

    tail = le32_to_cpu(*pipe->tail);

    tail += offset;

    if (tail >= pipe->native.length)

        tail -= pipe->native.length;

​

    len = min_t(size_t, count, pipe->native.length - tail);

    if (len)