Commit d3062a21 authored by Srinivas Kandagatla's avatar Srinivas Kandagatla Committed by Greg Kroah-Hartman

slimbus: messaging: add slim_alloc/free_txn_tid()

This patch adds slim_alloc_txn_tid() and slim_free_txn_tid() api
to allow controllers like ngd to allocate tids for user specific
commands. This also cleans up the existing code to use single place
for tid allocations and free.

This patch also make the tid allocation cyclic one, its very useful
to track the transactions back during debug.
Signed-off-by: default avatarSrinivas Kandagatla <srinivas.kandagatla@linaro.org>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent db455d66
...@@ -29,22 +29,19 @@ void slim_msg_response(struct slim_controller *ctrl, u8 *reply, u8 tid, u8 len) ...@@ -29,22 +29,19 @@ void slim_msg_response(struct slim_controller *ctrl, u8 *reply, u8 tid, u8 len)
spin_lock_irqsave(&ctrl->txn_lock, flags); spin_lock_irqsave(&ctrl->txn_lock, flags);
txn = idr_find(&ctrl->tid_idr, tid); txn = idr_find(&ctrl->tid_idr, tid);
if (txn == NULL) { spin_unlock_irqrestore(&ctrl->txn_lock, flags);
spin_unlock_irqrestore(&ctrl->txn_lock, flags);
if (txn == NULL)
return; return;
}
msg = txn->msg; msg = txn->msg;
if (msg == NULL || msg->rbuf == NULL) { if (msg == NULL || msg->rbuf == NULL) {
dev_err(ctrl->dev, "Got response to invalid TID:%d, len:%d\n", dev_err(ctrl->dev, "Got response to invalid TID:%d, len:%d\n",
tid, len); tid, len);
spin_unlock_irqrestore(&ctrl->txn_lock, flags);
return; return;
} }
idr_remove(&ctrl->tid_idr, tid); slim_free_txn_tid(ctrl, txn);
spin_unlock_irqrestore(&ctrl->txn_lock, flags);
memcpy(msg->rbuf, reply, len); memcpy(msg->rbuf, reply, len);
if (txn->comp) if (txn->comp)
complete(txn->comp); complete(txn->comp);
...@@ -55,6 +52,48 @@ void slim_msg_response(struct slim_controller *ctrl, u8 *reply, u8 tid, u8 len) ...@@ -55,6 +52,48 @@ void slim_msg_response(struct slim_controller *ctrl, u8 *reply, u8 tid, u8 len)
} }
EXPORT_SYMBOL_GPL(slim_msg_response); EXPORT_SYMBOL_GPL(slim_msg_response);
/**
* slim_alloc_txn_tid() - Allocate a tid to txn
*
* @ctrl: Controller handle
* @txn: transaction to be allocated with tid.
*
* Return: zero on success with valid txn->tid and error code on failures.
*/
int slim_alloc_txn_tid(struct slim_controller *ctrl, struct slim_msg_txn *txn)
{
unsigned long flags;
int ret = 0;
spin_lock_irqsave(&ctrl->txn_lock, flags);
ret = idr_alloc_cyclic(&ctrl->tid_idr, txn, 0,
SLIM_MAX_TIDS, GFP_ATOMIC);
if (ret < 0) {
spin_unlock_irqrestore(&ctrl->txn_lock, flags);
return ret;
}
txn->tid = ret;
spin_unlock_irqrestore(&ctrl->txn_lock, flags);
return 0;
}
EXPORT_SYMBOL_GPL(slim_alloc_txn_tid);
/**
* slim_free_txn_tid() - Freee tid of txn
*
* @ctrl: Controller handle
* @txn: transaction whose tid should be freed
*/
void slim_free_txn_tid(struct slim_controller *ctrl, struct slim_msg_txn *txn)
{
unsigned long flags;
spin_lock_irqsave(&ctrl->txn_lock, flags);
idr_remove(&ctrl->tid_idr, txn->tid);
spin_unlock_irqrestore(&ctrl->txn_lock, flags);
}
EXPORT_SYMBOL_GPL(slim_free_txn_tid);
/** /**
* slim_do_transfer() - Process a SLIMbus-messaging transaction * slim_do_transfer() - Process a SLIMbus-messaging transaction
* *
...@@ -72,8 +111,7 @@ int slim_do_transfer(struct slim_controller *ctrl, struct slim_msg_txn *txn) ...@@ -72,8 +111,7 @@ int slim_do_transfer(struct slim_controller *ctrl, struct slim_msg_txn *txn)
{ {
DECLARE_COMPLETION_ONSTACK(done); DECLARE_COMPLETION_ONSTACK(done);
bool need_tid = false, clk_pause_msg = false; bool need_tid = false, clk_pause_msg = false;
unsigned long flags; int ret, timeout;
int ret, tid, timeout;
/* /*
* do not vote for runtime-PM if the transactions are part of clock * do not vote for runtime-PM if the transactions are part of clock
...@@ -97,34 +135,26 @@ int slim_do_transfer(struct slim_controller *ctrl, struct slim_msg_txn *txn) ...@@ -97,34 +135,26 @@ int slim_do_transfer(struct slim_controller *ctrl, struct slim_msg_txn *txn)
need_tid = slim_tid_txn(txn->mt, txn->mc); need_tid = slim_tid_txn(txn->mt, txn->mc);
if (need_tid) { if (need_tid) {
spin_lock_irqsave(&ctrl->txn_lock, flags); ret = slim_alloc_txn_tid(ctrl, txn);
tid = idr_alloc(&ctrl->tid_idr, txn, 0, if (ret)
SLIM_MAX_TIDS, GFP_ATOMIC); return ret;
txn->tid = tid;
if (!txn->msg->comp) if (!txn->msg->comp)
txn->comp = &done; txn->comp = &done;
else else
txn->comp = txn->comp; txn->comp = txn->comp;
spin_unlock_irqrestore(&ctrl->txn_lock, flags);
if (tid < 0)
return tid;
} }
ret = ctrl->xfer_msg(ctrl, txn); ret = ctrl->xfer_msg(ctrl, txn);
if (ret && need_tid && !txn->msg->comp) { if (!ret && need_tid && !txn->msg->comp) {
unsigned long ms = txn->rl + HZ; unsigned long ms = txn->rl + HZ;
timeout = wait_for_completion_timeout(txn->comp, timeout = wait_for_completion_timeout(txn->comp,
msecs_to_jiffies(ms)); msecs_to_jiffies(ms));
if (!timeout) { if (!timeout) {
ret = -ETIMEDOUT; ret = -ETIMEDOUT;
spin_lock_irqsave(&ctrl->txn_lock, flags); slim_free_txn_tid(ctrl, txn);
idr_remove(&ctrl->tid_idr, tid);
spin_unlock_irqrestore(&ctrl->txn_lock, flags);
} }
} }
......
...@@ -240,6 +240,8 @@ int slim_unregister_controller(struct slim_controller *ctrl); ...@@ -240,6 +240,8 @@ int slim_unregister_controller(struct slim_controller *ctrl);
void slim_msg_response(struct slim_controller *ctrl, u8 *reply, u8 tid, u8 l); void slim_msg_response(struct slim_controller *ctrl, u8 *reply, u8 tid, u8 l);
int slim_do_transfer(struct slim_controller *ctrl, struct slim_msg_txn *txn); int slim_do_transfer(struct slim_controller *ctrl, struct slim_msg_txn *txn);
int slim_ctrl_clk_pause(struct slim_controller *ctrl, bool wakeup, u8 restart); int slim_ctrl_clk_pause(struct slim_controller *ctrl, bool wakeup, u8 restart);
int slim_alloc_txn_tid(struct slim_controller *ctrl, struct slim_msg_txn *txn);
void slim_free_txn_tid(struct slim_controller *ctrl, struct slim_msg_txn *txn);
static inline bool slim_tid_txn(u8 mt, u8 mc) static inline bool slim_tid_txn(u8 mt, u8 mc)
{ {
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment