From patchwork Thu Jan 12 22:32:23 2017 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Chris Bostic X-Patchwork-Id: 9514333 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork.web.codeaurora.org (Postfix) with ESMTP id 9312C60476 for ; Thu, 12 Jan 2017 22:32:53 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 97CC02870A for ; Thu, 12 Jan 2017 22:32:53 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 8907B28719; Thu, 12 Jan 2017 22:32:53 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-4.1 required=2.0 tests=BAYES_00, DKIM_ADSP_CUSTOM_MED, DKIM_SIGNED, FREEMAIL_FROM, RCVD_IN_DNSWL_MED, T_DKIM_INVALID autolearn=ham version=3.3.1 Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.9]) (using TLSv1.2 with cipher AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.wl.linuxfoundation.org (Postfix) with ESMTPS id 3A6452870A for ; Thu, 12 Jan 2017 22:32:53 +0000 (UTC) Received: from localhost ([127.0.0.1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.87 #1 (Red Hat Linux)) id 1cRnvQ-0000WJ-HJ; Thu, 12 Jan 2017 22:32:52 +0000 Received: from mail-pf0-x241.google.com ([2607:f8b0:400e:c00::241]) by bombadil.infradead.org with esmtps (Exim 4.87 #1 (Red Hat Linux)) id 1cRnvM-0000Iu-R8 for linux-arm-kernel@lists.infradead.org; Thu, 12 Jan 2017 22:32:50 +0000 Received: by mail-pf0-x241.google.com with SMTP id 127so5216452pfg.0 for ; Thu, 12 Jan 2017 14:32:28 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20161025; h=from:to:cc:subject:date:message-id; bh=mSfNspVDYvXI7AkLiYmSAsq+zjwNn95Yf2jOPV3ILoo=; b=VIJ15Z+GP7F6N3MiOZcLN+C4I+Gsxqk2berBaM7iNke/sXC4x8oJupzP+DAW4DkUqv lCxk//1tE9LvNRnWZhpF2/kPS0RULmQ8rnP0NwNclFk2ZMvaABjtsq8xUCuAtfWEe4W6 1fdtwLH1/XwS4aanJluRUOkwH9Ps1nfVjTuHJ3qLGxe96SZ2eUsIcggphWlalkr5XmIt vMD4D+vTK+agxwDpjXoINDEE6gfav4Z2ek0eQExctNX8f3iMXvf4FBMXK2ayBGz6hedu fHWelaI/L1Ec5Y+/RQmEtc9R5a5w+hr11ZSN5Vmq0Z4R3Xj02Htz0v7eyYAHVzgTIX3S iu3g== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id; bh=mSfNspVDYvXI7AkLiYmSAsq+zjwNn95Yf2jOPV3ILoo=; b=SPOgypMjCKYFjSzDXgqRHgSotrK35WabKxzIsunYXtvTYZdBtLFUufuH/YXPGMnB2B lBuvokDptqpoGSSIVyYtzbNJoClAdDp+WCw5CZyxNDH+ZxUh1y886/s9yjpTI6cuMz8l TmBCQy0ieDVF0liYP5ycUEkBmWR7yfuEkJGhfclAtRhxDygNrAAVqyt3KoPR4HHeULs2 GeNTrnfRtKHckfdq6zDlcDlAZXjNTlho5RtEFUbanZKhVUIIVjLahPQ8KU3f3/xPeCwq X73NXMbRuciun3OAV9yESZLN/xkN5lSn/MqWdtj/xRaIDpZ8SRtlEKYQT9aoADs7tq0L ho/g== X-Gm-Message-State: AIkVDXKHJuK+bwVyFdKc1Q+l7gh4JlW7NdKi0QF5RXxQTLPaxBm554yapsAjB9ruqInnYQ== X-Received: by 10.84.236.2 with SMTP id q2mr24889001plk.148.1484260348035; Thu, 12 Jan 2017 14:32:28 -0800 (PST) Received: from Christophers-MacBook-Pro.local.com (45-20-192-79.lightspeed.austtx.sbcglobal.net. [45.20.192.79]) by smtp.gmail.com with ESMTPSA id s136sm24076208pgs.46.2017.01.12.14.32.26 (version=TLS1 cipher=AES128-SHA bits=128/128); Thu, 12 Jan 2017 14:32:27 -0800 (PST) From: christopher.lee.bostic@gmail.com To: robh+dt@kernel.org, mark.rutland@arm.com, linux@armlinux.org.uk, gregkh@linuxfoundation.org, mturquette@baylibre.com, geert+renesas@glider.be, devicetree@vger.kernel.org, linux-arm-kernel@lists.infradead.org, joel@jms.id.au, jk@ozlabs.org, linux-kernel@vger.kernel.org, andrew@aj.id.au, alistair@popple.id.au, benh@kernel.crashing.org Subject: [PATCH v2 11/18] drivers/fsi: Set up links for slave communication Date: Thu, 12 Jan 2017 16:32:23 -0600 Message-Id: <1484260343-80012-1-git-send-email-christopher.lee.bostic@gmail.com> X-Mailer: git-send-email 2.7.4 (Apple Git-66) X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20170112_143248_919597_7DCB20AC X-CRM114-Status: GOOD ( 13.28 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.21 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: Chris Bostic MIME-Version: 1.0 Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org X-Virus-Scanned: ClamAV using ClamSMTP From: Chris Bostic Enable each link and send a break command in preparation for scanning each link for slaves. Signed-off-by: Chris Bostic Signed-off-by: Jeremy Kerr --- drivers/fsi/fsi-core.c | 38 ++++++++++++++++++++++++++++++++++++-- drivers/fsi/fsi-master.h | 2 ++ 2 files changed, 38 insertions(+), 2 deletions(-) diff --git a/drivers/fsi/fsi-core.c b/drivers/fsi/fsi-core.c index 3119aa1..b2c9274 100644 --- a/drivers/fsi/fsi-core.c +++ b/drivers/fsi/fsi-core.c @@ -271,14 +271,48 @@ static int fsi_slave_init(struct fsi_master *master, /* FSI master support */ +static int fsi_master_link_enable(struct fsi_master *master, int link) +{ + if (master->link_enable) + return master->link_enable(master, link); + + return 0; +} + +/* + * Issue a break command on this link + */ +static int fsi_master_break(struct fsi_master *master, int link) +{ + if (master->send_break) + return master->send_break(master, link); + + return 0; +} + static int fsi_master_scan(struct fsi_master *master) { - int link, slave_id; + int link, slave_id, rc; + + for (link = 0; link < master->n_links; link++) { + rc = fsi_master_link_enable(master, link); + if (rc) { + dev_dbg(master->dev, + "enable link:%d failed with:%d\n", link, rc); + continue; + } + rc = fsi_master_break(master, link); + if (rc) { + dev_dbg(master->dev, + "Break to link:%d failed with:%d\n", link, rc); + continue; + } - for (link = 0; link < master->n_links; link++) for (slave_id = 0; slave_id < FSI_N_SLAVES; slave_id++) fsi_slave_init(master, link, slave_id); + } + return 0; } diff --git a/drivers/fsi/fsi-master.h b/drivers/fsi/fsi-master.h index e75a810..94a0671 100644 --- a/drivers/fsi/fsi-master.h +++ b/drivers/fsi/fsi-master.h @@ -29,6 +29,8 @@ struct fsi_master { int (*write)(struct fsi_master *, int link, uint8_t slave, uint32_t addr, const void *val, size_t size); + int (*send_break)(struct fsi_master *, int link); + int (*link_enable)(struct fsi_master *, int link); }; extern int fsi_master_register(struct fsi_master *master);