Merge pull request #985 from hzhuang1/remove_mailbox
hikey960: remove mailbox driver
This commit is contained in:
davidcunado-arm
GitHub
commit
b4ebf54593
|
|
@ -1,166 +0,0 @@
|
|||
/*
|
||||
* 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;
|
||||
}
|
||||
Loading…
Reference in New Issue