mirror of
https://github.com/Fishwaldo/Star64_linux.git
synced 2025-04-01 03:54:02 +00:00
omap: mailbox: remove sequence bit checking
Any protocol should be handled in the upper layer and mailbox driver shouldn't care about the contents of messages. Signed-off-by: Hiroshi DOYU <Hiroshi.DOYU@nokia.com> Signed-off-by: Tony Lindgren <tony@atomide.com>
This commit is contained in:
parent
454bf340c9
commit
bfe1f6acb0
1 changed files with 4 additions and 66 deletions
|
@ -28,54 +28,9 @@
|
||||||
|
|
||||||
#include <plat/mailbox.h>
|
#include <plat/mailbox.h>
|
||||||
|
|
||||||
static int enable_seq_bit;
|
|
||||||
module_param(enable_seq_bit, bool, 0);
|
|
||||||
MODULE_PARM_DESC(enable_seq_bit, "Enable sequence bit checking.");
|
|
||||||
|
|
||||||
static struct omap_mbox *mboxes;
|
static struct omap_mbox *mboxes;
|
||||||
static DEFINE_RWLOCK(mboxes_lock);
|
static DEFINE_RWLOCK(mboxes_lock);
|
||||||
|
|
||||||
/*
|
|
||||||
* Mailbox sequence bit API
|
|
||||||
*/
|
|
||||||
|
|
||||||
/* seq_rcv should be initialized with any value other than
|
|
||||||
* 0 and 1 << 31, to allow either value for the first
|
|
||||||
* message. */
|
|
||||||
static inline void mbox_seq_init(struct omap_mbox *mbox)
|
|
||||||
{
|
|
||||||
if (!enable_seq_bit)
|
|
||||||
return;
|
|
||||||
|
|
||||||
/* any value other than 0 and 1 << 31 */
|
|
||||||
mbox->seq_rcv = 0xffffffff;
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void mbox_seq_toggle(struct omap_mbox *mbox, mbox_msg_t * msg)
|
|
||||||
{
|
|
||||||
if (!enable_seq_bit)
|
|
||||||
return;
|
|
||||||
|
|
||||||
/* add seq_snd to msg */
|
|
||||||
*msg = (*msg & 0x7fffffff) | mbox->seq_snd;
|
|
||||||
/* flip seq_snd */
|
|
||||||
mbox->seq_snd ^= 1 << 31;
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline int mbox_seq_test(struct omap_mbox *mbox, mbox_msg_t msg)
|
|
||||||
{
|
|
||||||
mbox_msg_t seq;
|
|
||||||
|
|
||||||
if (!enable_seq_bit)
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
seq = msg & (1 << 31);
|
|
||||||
if (seq == mbox->seq_rcv)
|
|
||||||
return -1;
|
|
||||||
mbox->seq_rcv = seq;
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Mailbox FIFO handle functions */
|
/* Mailbox FIFO handle functions */
|
||||||
static inline mbox_msg_t mbox_fifo_read(struct omap_mbox *mbox)
|
static inline mbox_msg_t mbox_fifo_read(struct omap_mbox *mbox)
|
||||||
{
|
{
|
||||||
|
@ -113,13 +68,6 @@ static inline int is_mbox_irq(struct omap_mbox *mbox, omap_mbox_irq_t irq)
|
||||||
return mbox->ops->is_irq(mbox, irq);
|
return mbox->ops->is_irq(mbox, irq);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Mailbox Sequence Bit function */
|
|
||||||
void omap_mbox_init_seq(struct omap_mbox *mbox)
|
|
||||||
{
|
|
||||||
mbox_seq_init(mbox);
|
|
||||||
}
|
|
||||||
EXPORT_SYMBOL(omap_mbox_init_seq);
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* message sender
|
* message sender
|
||||||
*/
|
*/
|
||||||
|
@ -141,7 +89,6 @@ static int __mbox_msg_send(struct omap_mbox *mbox, mbox_msg_t msg, void *arg)
|
||||||
goto out;
|
goto out;
|
||||||
}
|
}
|
||||||
|
|
||||||
mbox_seq_toggle(mbox, &msg);
|
|
||||||
mbox_fifo_write(mbox, msg);
|
mbox_fifo_write(mbox, msg);
|
||||||
out:
|
out:
|
||||||
return ret;
|
return ret;
|
||||||
|
@ -254,11 +201,11 @@ static void mbox_rx_work(struct work_struct *work)
|
||||||
/*
|
/*
|
||||||
* Mailbox interrupt handler
|
* Mailbox interrupt handler
|
||||||
*/
|
*/
|
||||||
static void mbox_txq_fn(struct request_queue * q)
|
static void mbox_txq_fn(struct request_queue *q)
|
||||||
{
|
{
|
||||||
}
|
}
|
||||||
|
|
||||||
static void mbox_rxq_fn(struct request_queue * q)
|
static void mbox_rxq_fn(struct request_queue *q)
|
||||||
{
|
{
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -284,11 +231,6 @@ static void __mbox_rx_interrupt(struct omap_mbox *mbox)
|
||||||
|
|
||||||
msg = mbox_fifo_read(mbox);
|
msg = mbox_fifo_read(mbox);
|
||||||
|
|
||||||
if (unlikely(mbox_seq_test(mbox, msg))) {
|
|
||||||
pr_info("mbox: Illegal seq bit!(%08x)\n", msg);
|
|
||||||
if (mbox->err_notify)
|
|
||||||
mbox->err_notify();
|
|
||||||
}
|
|
||||||
|
|
||||||
blk_insert_request(q, rq, 0, (void *)msg);
|
blk_insert_request(q, rq, 0, (void *)msg);
|
||||||
if (mbox->ops->type == OMAP_MBOX_TYPE1)
|
if (mbox->ops->type == OMAP_MBOX_TYPE1)
|
||||||
|
@ -320,7 +262,7 @@ static irqreturn_t mbox_interrupt(int irq, void *p)
|
||||||
*/
|
*/
|
||||||
static ssize_t
|
static ssize_t
|
||||||
omap_mbox_write(struct device *dev, struct device_attribute *attr,
|
omap_mbox_write(struct device *dev, struct device_attribute *attr,
|
||||||
const char * buf, size_t count)
|
const char *buf, size_t count)
|
||||||
{
|
{
|
||||||
int ret;
|
int ret;
|
||||||
mbox_msg_t *p = (mbox_msg_t *)buf;
|
mbox_msg_t *p = (mbox_msg_t *)buf;
|
||||||
|
@ -357,10 +299,6 @@ omap_mbox_read(struct device *dev, struct device_attribute *attr, char *buf)
|
||||||
|
|
||||||
blk_end_request_all(rq, 0);
|
blk_end_request_all(rq, 0);
|
||||||
|
|
||||||
if (unlikely(mbox_seq_test(mbox, *p))) {
|
|
||||||
pr_info("mbox: Illegal seq bit!(%08x) ignored\n", *p);
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
p++;
|
p++;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -383,7 +321,7 @@ static struct class omap_mbox_class = {
|
||||||
};
|
};
|
||||||
|
|
||||||
static struct omap_mbox_queue *mbox_queue_alloc(struct omap_mbox *mbox,
|
static struct omap_mbox_queue *mbox_queue_alloc(struct omap_mbox *mbox,
|
||||||
request_fn_proc * proc,
|
request_fn_proc *proc,
|
||||||
void (*work) (struct work_struct *))
|
void (*work) (struct work_struct *))
|
||||||
{
|
{
|
||||||
struct request_queue *q;
|
struct request_queue *q;
|
||||||
|
|
Loading…
Add table
Reference in a new issue