On Wed, Nov 15, 2017 at 02:10:41PM +0000, srinivas.kandagatla@xxxxxxxxxx wrote:
> From: Sagar Dharia <sdharia@xxxxxxxxxxxxxx>
>
> This controller driver programs manager, interface, and framer
> devices for Qualcomm's slimbus HW block.
> Manager component currently implements logical address setting,
> and messaging interface.
> Interface device reports bus synchronization information, and framer
> device clocks the bus from the time it's woken up, until clock-pause
> is executed by the manager device.
>
> Signed-off-by: Sagar Dharia <sdharia@xxxxxxxxxxxxxx>
> Signed-off-by: Srinivas Kandagatla <srinivas.kandagatla@xxxxxxxxxx>
> ---
> +
> +static irqreturn_t qcom_slim_handle_rx_irq(struct qcom_slim_ctrl *ctrl,
> + u32 stat)
> +{
> + u32 *rx_buf, pkt[10];
> + bool q_rx = false;
> + u8 la, *buf, mc, mt, len, *b = (u8 *)&pkt[0];
> + u16 ele;
> +
This function feels pretty funky, we basically have rx_buf, pkt,
b and buf all of which basically point to the same thing. Can we
simplify it a little?
> + pkt[0] = readl_relaxed(ctrl->base + MGR_RX_MSG);
> + mt = SLIM_HEADER_GET_MT(b[0]);
> + len = SLIM_HEADER_GET_RL(b[0]);
> + mc = SLIM_HEADER_GET_MC(b[1]);
> +
> + /*
> + * this message cannot be handled by ISR, so
> + * let work-queue handle it
> + */
> + if (mt == SLIM_MSG_MT_CORE &&
> + mc == SLIM_MSG_MC_REPORT_PRESENT)
> + rx_buf = (u32 *)slim_alloc_rxbuf(ctrl);
> + else
> + rx_buf = pkt;
> +
> + if (rx_buf == NULL) {
> + dev_err(ctrl->dev, "dropping RX:0x%x due to RX full\n",
> + pkt[0]);
> + goto rx_ret_irq;
> + }
> +
> + rx_buf[0] = pkt[0];
This is the only time that rx_buf is used without being cast to a
u8* would there be any milage in combining b and buf, and getting
rid of rx_buf?
> + __ioread32_copy(rx_buf + 1, ctrl->base + MGR_RX_MSG + 4,
> + DIV_ROUND_UP(len, 4));
> +
> + switch (mc) {
> +
> + case SLIM_MSG_MC_REPORT_PRESENT:
> + q_rx = true;
> + break;
> + case SLIM_MSG_MC_REPLY_INFORMATION:
> + case SLIM_MSG_MC_REPLY_VALUE:
> + slim_msg_response(&ctrl->ctrl, (u8 *)(rx_buf + 1),
> + (u8)(*rx_buf >> 24), (len - 4));
> + break;
> + case SLIM_MSG_MC_REPORT_INFORMATION:
> + buf = (u8 *)rx_buf;
> + la = buf[2];
> + ele = (u16)buf[4] << 4;
> +
> + ele |= ((buf[3] & 0xf0) >> 4);
> + /*
> + * report information is most likely loss of
> + * sync or collision detected in data slots
> + */
> + dev_info(ctrl->dev, "LA:%d report inf ele:0x%x\n",
> + la, ele);
> + break;
> + default:
> + dev_err(ctrl->dev, "unsupported MC,%x MT:%x\n",
> + mc, mt);
> + break;
> + }
> +rx_ret_irq:
> + writel(MGR_INT_RX_MSG_RCVD, ctrl->base +
> + MGR_INT_CLR);
> + if (q_rx)
> + queue_work(ctrl->rxwq, &ctrl->wd);
> +
> + return IRQ_HANDLED;
> +}
> +
> +static int qcom_xfer_msg(struct slim_controller *sctrl,
> + struct slim_msg_txn *txn)
> +{
> + struct qcom_slim_ctrl *ctrl = dev_get_drvdata(sctrl->dev);
> + DECLARE_COMPLETION_ONSTACK(done);
> + void *pbuf = slim_alloc_txbuf(ctrl, txn, &done);
> + unsigned long ms = txn->rl + HZ;
> + u8 *puc;
> + int ret = 0, timeout, retries = QCOM_BUF_ALLOC_RETRIES;
> + u8 la = txn->la;
> + u32 *head;
> + /* HW expects length field to be excluded */
> + txn->rl--;
> +
> + /* spin till buffer is made available */
> + if (!pbuf) {
> + while (retries--) {
> + usleep_range(10000, 15000);
> + pbuf = slim_alloc_txbuf(ctrl, txn, &done);
> + if (pbuf)
> + break;
> + }
> + }
> +
> + if (!retries && !pbuf)
> + return -ENOMEM;
> +
> + puc = (u8 *)pbuf;
> + head = (u32 *)pbuf;
> +
> + if (txn->dt == SLIM_MSG_DEST_LOGICALADDR)
> + *head = SLIM_MSG_ASM_FIRST_WORD(txn->rl, txn->mt, txn->mc, 0,
> + la);
> + else
> + *head = SLIM_MSG_ASM_FIRST_WORD(txn->rl, txn->mt, txn->mc, 1,
> + la);
> +
> + if (txn->dt == SLIM_MSG_DEST_LOGICALADDR)
> + puc += 3;
> + else
> + puc += 2;
Combine these two if statements, makes it much clearer the actions
are related.
> +
> + if (txn->mt == SLIM_MSG_MT_CORE && slim_tid_txn(txn->mt, txn->mc))
slim_tid_txn checks for SLIM_MSG_MT_CORE so the check here should
be redundant.
> + *(puc++) = txn->tid;
> +
> + if ((txn->mt == SLIM_MSG_MT_CORE) &&
> + ((txn->mc >= SLIM_MSG_MC_REQUEST_INFORMATION &&
> + txn->mc <= SLIM_MSG_MC_REPORT_INFORMATION) ||
> + (txn->mc >= SLIM_MSG_MC_REQUEST_VALUE &&
> + txn->mc <= SLIM_MSG_MC_CHANGE_VALUE))) {
> + *(puc++) = (txn->ec & 0xFF);
> + *(puc++) = (txn->ec >> 8) & 0xFF;
> + }
As you already have slim_tid_txn, would it be worth adding
something like slim_ec_txn? To state if an element code is
required, feels like other controls will probably want to do a
similar thing and would make the code a little more readable
here.
> +
> + if (txn->msg && txn->msg->wbuf)
> + memcpy(puc, txn->msg->wbuf, txn->msg->num_bytes);
> +
> + qcom_slim_queue_tx(ctrl, head, txn->rl, MGR_TX_MSG);
> + timeout = wait_for_completion_timeout(&done, msecs_to_jiffies(ms));
> +
> + if (!timeout) {
> + dev_err(ctrl->dev, "TX timed out:MC:0x%x,mt:0x%x", txn->mc,
> + txn->mt);
> + ret = -ETIMEDOUT;
> + }
> +
> + return ret;
> +
> +}
> +
> +static void qcom_slim_rxwq(struct work_struct *work)
> +{
> + u8 buf[SLIM_MSGQ_BUF_LEN];
> + u8 mc, mt, len;
> + int i, ret;
> + struct qcom_slim_ctrl *ctrl = container_of(work, struct qcom_slim_ctrl,
> + wd);
> +
> + while ((slim_get_current_rxbuf(ctrl, buf)) != -ENODATA) {
> + len = SLIM_HEADER_GET_RL(buf[0]);
> + mt = SLIM_HEADER_GET_MT(buf[0]);
> + mc = SLIM_HEADER_GET_MC(buf[1]);
> + if (mt == SLIM_MSG_MT_CORE &&
> + mc == SLIM_MSG_MC_REPORT_PRESENT) {
> + u8 laddr;
> + struct slim_eaddr ea;
> + u8 e_addr[6];
> +
> + for (i = 0; i < 6; i++)
> + e_addr[i] = buf[7-i];
> +
> + ea.manf_id = (u16)(e_addr[5] << 8) | e_addr[4];
> + ea.prod_code = (u16)(e_addr[3] << 8) | e_addr[2];
> + ea.dev_index = e_addr[1];
> + ea.instance = e_addr[0];
If we are just bitshifting this out of the bytes does it really
make it much more clear to reverse the byte order first? Feels
like you might as well shift it out of buf directly.
Also we didn't bother to reverse the bytes for the element code
above, so feels more consistent.
> + ret = slim_device_report_present(&ctrl->ctrl,
> + &ea, &laddr);
> + if (ret < 0)
> + dev_err(ctrl->dev, "assign laddr failed:%d\n",
> + ret);
> + } else {
> + dev_err(ctrl->dev, "unexpected message:mc:%x, mt:%x\n",
> + mc, mt);
> + }
> + }
> +}
Thanks,
Charles
--
To unsubscribe from this list: send the line "unsubscribe linux-arm-msm" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
