hi3660_mailbox.c

/*
 * Copyright (c) 2017, ARM Limited and Contributors. All rights reserved.
 *
 * SPDX-License-Identifier: BSD-3-Clause
 */
#include <assert.h>
#include <debug.h>
#include <errno.h>
#include <hi3660_mailbox.h>
#include <mailbox.h>
#include <mmio.h>
#include <string.h>

typedef struct hi3660_chan {
	unsigned char	src;
	unsigned char	dst;
	unsigned char	used;
} hi3660_chan_t;

static hi3660_chan_t chan_map[MBX_MAX_CHANNELS];

static void hi3660_mbox_check_state(int chan, unsigned int state)
{
	unsigned int data;

	data = mmio_read_32(MBX_MODE(chan));
	assert((data & (MBX_MODE_AUTO_ANSWER | MBX_MODE_AUTO_LINK)) == 0);

	data &= MBX_MODE_STATE_STATUS_MASK;
	assert(data == state);
	(void)state;
}

static int hi3660_mbox_send(int chan, void *message, int len)
{
	int i;
	unsigned int *buf;
	unsigned int data;

	assert((chan >= 0) && (chan < MBX_MAX_CHANNELS) &&
	       (message != NULL) && (len <= MBX_MAX_DATA_LEN));
	assert((chan_map[chan].used != 0) &&
	       (chan_map[chan].src != 0) &&
	       (chan_map[chan].dst != 0));

	buf = (unsigned int *)message;
	len = ((len + 3) >> 2);		/* convert to word count */
	for (i = 0; i < len; i++)
		mmio_write_32(MBX_DATA0(chan) + (i << 2), *(buf + i));
	/* send out */
	mmio_write_32(MBX_SEND(chan), chan_map[chan].src);

	do {
		data = mmio_read_32(MBX_ICLR(chan));
	} while ((data & chan_map[chan].src) == 0);
	/* ack */
	mmio_write_32(MBX_ICLR(chan), chan_map[chan].src);
	return 0;
}

static int hi3660_mbox_recv(int chan, void *message, int *len)
{
	unsigned int *buf, data;
	int i;

	assert((chan >= 0) && (chan < MBX_MAX_CHANNELS) &&
	       (message != NULL) && (len != NULL));
	assert((chan_map[chan].used != 0) &&
	       (chan_map[chan].src != 0) &&
	       (chan_map[chan].dst != 0));
	/* wait IPC event */
	do {
		data = mmio_read_32(MBX_MODE(chan));
	} while ((data & MBX_MODE_STATE_STATUS_MASK) != MBX_MODE_STATE_DEST);
	/* wait to clear interrupt */
	do {
		data = mmio_read_32(MBX_ICLR(chan));
	} while (data == 0);
	do {
		mmio_write_32(MBX_ICLR(chan), chan_map[chan].dst);
		data = mmio_read_32(MBX_ICLR(chan));
	} while (data);

	/* read data from IPC */
	buf = (unsigned int *)message;
	for (i = 0; i < MBX_MAX_DATA_LEN; i += 4)
		*(buf + (i >> 2)) = mmio_read_32(MBX_DATA0(chan) + i);
	*len = MBX_MAX_DATA_LEN;
	/* ack */
	mmio_write_32(MBX_SEND(chan), chan_map[chan].dst);
	return 0;
}

static int hi3660_mbox_request(int chan, int direction)
{
	unsigned int data;
	unsigned int src, dst;

	assert((chan >= 0) && (chan < MBX_MAX_CHANNELS));

	if (direction == MAILBOX_DIR_TX) {
		src = CPU_A53;
		dst = CPU_LPM3;
	} else if (direction == MAILBOX_DIR_RX) {
		src = CPU_LPM3;
		dst = CPU_A53;
	} else
		assert(0);
	mmio_write_32(MBX_SOURCE(chan), src);
	data = mmio_read_32(MBX_SOURCE(chan));
	assert(data == src);

	/* mask all interrupts */
	mmio_write_32(MBX_IMASK(chan), CPU_MASK);
	/* unmask interrupt */
	mmio_write_32(MBX_IMASK(chan), ~(src | dst));

	/* set destination */
	mmio_write_32(MBX_DCLEAR(chan), (~dst) & CPU_MASK);
	mmio_write_32(MBX_DSET(chan), dst);
	data = mmio_read_32(MBX_DSTATUS(chan));
	assert((data & dst) != 0);

	/* clear auto link & auto answer */
	data = mmio_read_32(MBX_MODE(chan));
	data &= ~(MBX_MODE_AUTO_ANSWER | MBX_MODE_AUTO_LINK);
	mmio_write_32(MBX_MODE(chan), data);

	hi3660_mbox_check_state(chan, MBX_MODE_STATE_SOURCE);
	chan_map[chan].used = 1;
	chan_map[chan].src = src;
	chan_map[chan].dst = dst;
	return 0;
}

static void hi3660_mbox_free(int chan)
{
	assert((chan >= 0) && (chan < MBX_MAX_CHANNELS));
}

static mbox_ops_t hi3660_mbox_ops = {
	.send		= hi3660_mbox_send,
	.recv		= hi3660_mbox_recv,
	.request	= hi3660_mbox_request,
	.free		= hi3660_mbox_free,
};

int hi3660_mbox_init(mbox_params_t *params)
{
	int result;
	unsigned int data;

	assert(params != NULL);
	result = mbox_init(&hi3660_mbox_ops, params);
	assert(result == 0);
	memset(&chan_map, 0, sizeof(chan_map));

	/* unlock mailbox */
	data = mmio_read_32(IPC_LOCK);
	while (data == MBX_IPC_LOCKED) {
		mmio_write_32(IPC_LOCK, MBX_IPC_UNLOCK_MAGIC);
		data = mmio_read_32(IPC_LOCK);
	}
	(void)result;
	return 0;
}