From patchwork Thu Aug 24 07:21:36 2017 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Sricharan Ramabadhran X-Patchwork-Id: 110869 Delivered-To: patch@linaro.org Received: by 10.37.128.210 with SMTP id c18csp8065839ybm; Thu, 24 Aug 2017 00:22:51 -0700 (PDT) X-Received: by 10.98.210.135 with SMTP id c129mr5037610pfg.314.1503559371088; Thu, 24 Aug 2017 00:22:51 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1503559371; cv=none; d=google.com; s=arc-20160816; b=kmkLy8FQzXsS2yWLBRZCEXlCJ754RZN+Vwy1PWQQ3CoVkqVWzsMu2Z7CgUtpRunkiA aKwZumjzu4pGNblJX0GcB8DeA5G4+tN/Mht42Xshu0JL9xlIe2Ag2TkumG4rkznEtJ5M z+kzAwnR70VjQ+qFdPloA32lorhrZGOG2l/vOF9pIoOKk4uyw5UNmqzI0zqHIGu9Uq/S CoXtmSvanDbOVAM09WqsfY05wz2dLghuHSukiPfyVgrJwl4WuRPexM6UN/4iBE/AcQul K7X0UrxY4+BNMl5WLi1jkQGKozTBdbcYFGuaFEpLluRiQTtdc2nUXISz9z9/pjJFvwyg UC/g== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:sender:references:in-reply-to:message-id:date :subject:cc:to:from:dmarc-filter:dkim-signature:dkim-signature :arc-authentication-results; bh=XwePIilhbdFYs4qTXaai9WEPzv8Sjiu4BBEKeCU9vmk=; b=No2p8H08QIo4wz/LAu97HnrwV51BfbQi9St0eLP9lrIDhlhUmLpkiIhJOIWdLFluP3 1S1dZdIePJ8DAUdac4YisrOHaqr/sdNkEv2Hn/Cxd9ngYrwBTHlvLgVot4qkuYnrP9Pg a7FO/DngHP+J4u8yGnZAufQfY9xMkZyZiNvGB7Ct+n6whlkYfKcnVWJZp3SY4e8s0qiO RnStPh7mu0Vtas8mcZRBpUt1ZW7KxmIzDT42+YkzP8FyRP/yGpsqRhwhkMfY5QGPpA2I Eyuugy/Jx4rW4cSU1xhWh53CD5QxEULdYIS8ARk2F3ydQf/j2fbx1/tCJoTiSRtsjeTj TQpg== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@codeaurora.org header.s=default header.b=CyOTxu06; dkim=pass header.i=@codeaurora.org header.s=default header.b=QTQIm+04; spf=pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org Return-Path: Received: from vger.kernel.org (vger.kernel.org. [209.132.180.67]) by mx.google.com with ESMTP id d6si2390492pgt.177.2017.08.24.00.22.50; Thu, 24 Aug 2017 00:22:51 -0700 (PDT) Received-SPF: pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) client-ip=209.132.180.67; Authentication-Results: mx.google.com; dkim=pass header.i=@codeaurora.org header.s=default header.b=CyOTxu06; dkim=pass header.i=@codeaurora.org header.s=default header.b=QTQIm+04; spf=pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1751831AbdHXHWt (ORCPT + 26 others); Thu, 24 Aug 2017 03:22:49 -0400 Received: from smtp.codeaurora.org ([198.145.29.96]:35018 "EHLO smtp.codeaurora.org" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1751708AbdHXHWp (ORCPT ); Thu, 24 Aug 2017 03:22:45 -0400 Received: by smtp.codeaurora.org (Postfix, from userid 1000) id 7F03660723; Thu, 24 Aug 2017 07:22:40 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=codeaurora.org; s=default; t=1503559364; bh=XaLAmCVkkzeU/fWT99d85w9Yw/ll/8RkjAFvuODH/sE=; h=From:To:Cc:Subject:Date:In-Reply-To:References:From; b=CyOTxu06CckhCBxtf7zlgD7n211f6cystjh00cw/I24SQ2hRVQE3SR8m8ttqDZIN7 ECaQuZhK1BkI097AAMIEdjX0JVSUgDpALuomeI6e6YdKbp1QDk/ONQEx5KxrLYc2eo 93C5To3UdR9e/L3P6aivUk5Qxzv+34cRoVJ5WGCQ= X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on pdx-caf-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-2.8 required=2.0 tests=ALL_TRUSTED,BAYES_00, DKIM_SIGNED, T_DKIM_INVALID autolearn=no autolearn_force=no version=3.4.0 Received: from srichara-linux.qualcomm.com (blr-c-bdr-fw-01_globalnat_allzones-outside.qualcomm.com [103.229.19.19]) (using TLSv1.2 with cipher ECDHE-RSA-AES128-SHA256 (128/128 bits)) (No client certificate requested) (Authenticated sender: sricharan@smtp.codeaurora.org) by smtp.codeaurora.org (Postfix) with ESMTPSA id ADDE360710; Thu, 24 Aug 2017 07:22:35 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=codeaurora.org; s=default; t=1503559358; bh=XaLAmCVkkzeU/fWT99d85w9Yw/ll/8RkjAFvuODH/sE=; h=From:To:Cc:Subject:Date:In-Reply-To:References:From; b=QTQIm+04ixKoOiJ1FY2x2RpNfcCUXangQPzEiHBwY0Mi/G2QUogLy311DqyDLKSth ykIF3kYgkkdJcggo9oUQvAVKrfB7IV0gwh36A8mASPrJkJDmb4fTep6Ztj8PshC5lR /WmQBmkYNPo9f5R9HbGwQVZZl/8i5ixWvZL0nFKU= DMARC-Filter: OpenDMARC Filter v1.3.2 smtp.codeaurora.org ADDE360710 Authentication-Results: pdx-caf-mail.web.codeaurora.org; dmarc=none (p=none dis=none) header.from=codeaurora.org Authentication-Results: pdx-caf-mail.web.codeaurora.org; spf=none smtp.mailfrom=sricharan@codeaurora.org From: Sricharan R To: ohad@wizery.com, bjorn.andersson@linaro.org, linux-remoteproc@vger.kernel.org, linux-kernel@vger.kernel.org, linux-arm-msm@vger.kernel.org, linux-arm-kernel@lists.infradead.org Cc: sricharan@codeaurora.org Subject: [PATCH v2 14/20] rpmsg: glink: Make RX FIFO peak accessor to take an offset Date: Thu, 24 Aug 2017 12:51:36 +0530 Message-Id: <1503559302-3744-15-git-send-email-sricharan@codeaurora.org> X-Mailer: git-send-email 1.9.1 In-Reply-To: <1503559302-3744-1-git-send-email-sricharan@codeaurora.org> References: <1503559302-3744-1-git-send-email-sricharan@codeaurora.org> Sender: linux-kernel-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org From: Bjorn Andersson To fully read the received rx data from FIFO both the command and data has to be read. Currently we read command, data separately and process them. By adding an offset parameter to RX FIFO peak accessor, command and data can be read together, simplifying things. So introduce this. Signed-off-by: Bjorn Andersson Signed-off-by: Sricharan R --- drivers/rpmsg/qcom_glink_native.c | 15 +++++++-------- drivers/rpmsg/qcom_glink_native.h | 2 +- drivers/rpmsg/qcom_glink_rpm.c | 5 ++++- drivers/rpmsg/qcom_glink_smem.c | 5 ++++- 4 files changed, 16 insertions(+), 11 deletions(-) -- QUALCOMM INDIA, on behalf of Qualcomm Innovation Center, Inc. is a member of Code Aurora Forum, hosted by The Linux Foundation Acked-by: Arun Kumar Neelakantam diff --git a/drivers/rpmsg/qcom_glink_native.c b/drivers/rpmsg/qcom_glink_native.c index 67eeb86..ff83cbb 100644 --- a/drivers/rpmsg/qcom_glink_native.c +++ b/drivers/rpmsg/qcom_glink_native.c @@ -233,9 +233,9 @@ static size_t qcom_glink_rx_avail(struct qcom_glink *glink) } static void qcom_glink_rx_peak(struct qcom_glink *glink, - void *data, size_t count) + void *data, unsigned int offset, size_t count) { - glink->rx_pipe->peak(glink->rx_pipe, data, count); + glink->rx_pipe->peak(glink->rx_pipe, data, offset, count); } static void qcom_glink_rx_advance(struct qcom_glink *glink, size_t count) @@ -600,7 +600,7 @@ static int qcom_glink_rx_defer(struct qcom_glink *glink, size_t extra) INIT_LIST_HEAD(&dcmd->node); - qcom_glink_rx_peak(glink, &dcmd->msg, sizeof(dcmd->msg) + extra); + qcom_glink_rx_peak(glink, &dcmd->msg, 0, sizeof(dcmd->msg) + extra); spin_lock(&glink->rx_lock); list_add_tail(&dcmd->node, &glink->rx_queue); @@ -633,7 +633,7 @@ static int qcom_glink_rx_data(struct qcom_glink *glink, size_t avail) return -EAGAIN; } - qcom_glink_rx_peak(glink, &hdr, sizeof(hdr)); + qcom_glink_rx_peak(glink, &hdr, 0, sizeof(hdr)); chunk_size = le32_to_cpu(hdr.chunk_size); left_size = le32_to_cpu(hdr.left_size); @@ -700,9 +700,8 @@ static int qcom_glink_rx_data(struct qcom_glink *glink, size_t avail) goto advance_rx; } - qcom_glink_rx_advance(glink, ALIGN(sizeof(hdr), 8)); qcom_glink_rx_peak(glink, intent->data + intent->offset, - chunk_size); + sizeof(hdr), chunk_size); intent->offset += chunk_size; /* Handle message when no fragments remain to be received */ @@ -722,7 +721,7 @@ static int qcom_glink_rx_data(struct qcom_glink *glink, size_t avail) } advance_rx: - qcom_glink_rx_advance(glink, ALIGN(chunk_size, 8)); + qcom_glink_rx_advance(glink, ALIGN(sizeof(hdr) + chunk_size, 8)); return ret; } @@ -759,7 +758,7 @@ static irqreturn_t qcom_glink_native_intr(int irq, void *data) if (avail < sizeof(msg)) break; - qcom_glink_rx_peak(glink, &msg, sizeof(msg)); + qcom_glink_rx_peak(glink, &msg, 0, sizeof(msg)); cmd = le16_to_cpu(msg.cmd); param1 = le16_to_cpu(msg.param1); diff --git a/drivers/rpmsg/qcom_glink_native.h b/drivers/rpmsg/qcom_glink_native.h index 92e0881..0cae8a8 100644 --- a/drivers/rpmsg/qcom_glink_native.h +++ b/drivers/rpmsg/qcom_glink_native.h @@ -24,7 +24,7 @@ struct qcom_glink_pipe { size_t (*avail)(struct qcom_glink_pipe *glink_pipe); void (*peak)(struct qcom_glink_pipe *glink_pipe, void *data, - size_t count); + unsigned int offset, size_t count); void (*advance)(struct qcom_glink_pipe *glink_pipe, size_t count); void (*write)(struct qcom_glink_pipe *glink_pipe, diff --git a/drivers/rpmsg/qcom_glink_rpm.c b/drivers/rpmsg/qcom_glink_rpm.c index 5a86e08..69b25d1 100644 --- a/drivers/rpmsg/qcom_glink_rpm.c +++ b/drivers/rpmsg/qcom_glink_rpm.c @@ -77,13 +77,16 @@ static size_t glink_rpm_rx_avail(struct qcom_glink_pipe *glink_pipe) } static void glink_rpm_rx_peak(struct qcom_glink_pipe *glink_pipe, - void *data, size_t count) + void *data, unsigned int offset, size_t count) { struct glink_rpm_pipe *pipe = to_rpm_pipe(glink_pipe); unsigned int tail; size_t len; tail = readl(pipe->tail); + tail += offset; + if (tail >= pipe->native.length) + tail -= pipe->native.length; len = min_t(size_t, count, pipe->native.length - tail); if (len) { diff --git a/drivers/rpmsg/qcom_glink_smem.c b/drivers/rpmsg/qcom_glink_smem.c index 9d73ced..5cdaa5f 100644 --- a/drivers/rpmsg/qcom_glink_smem.c +++ b/drivers/rpmsg/qcom_glink_smem.c @@ -87,13 +87,16 @@ static size_t glink_smem_rx_avail(struct qcom_glink_pipe *np) } static void glink_smem_rx_peak(struct qcom_glink_pipe *np, - void *data, size_t count) + void *data, unsigned int offset, size_t count) { struct glink_smem_pipe *pipe = to_smem_pipe(np); size_t len; u32 tail; tail = le32_to_cpu(*pipe->tail); + tail += offset; + if (tail >= pipe->native.length) + tail -= pipe->native.length; len = min_t(size_t, count, pipe->native.length - tail); if (len) {