19f4a8a2dSBenjamin Herrenschmidt // SPDX-License-Identifier: GPL-2.0
29f4a8a2dSBenjamin Herrenschmidt /*
39f4a8a2dSBenjamin Herrenschmidt * Copyright (C) IBM Corporation 2017
49f4a8a2dSBenjamin Herrenschmidt *
59f4a8a2dSBenjamin Herrenschmidt * This program is free software; you can redistribute it and/or modify
69f4a8a2dSBenjamin Herrenschmidt * it under the terms of the GNU General Public License version 2 as
79f4a8a2dSBenjamin Herrenschmidt * published by the Free Software Foundation.
89f4a8a2dSBenjamin Herrenschmidt *
99f4a8a2dSBenjamin Herrenschmidt * This program is distributed in the hope that it will be useful,
109f4a8a2dSBenjamin Herrenschmidt * but WITHOUT ANY WARRANTY; without even the implied warranty of
119f4a8a2dSBenjamin Herrenschmidt * MERGCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
129f4a8a2dSBenjamin Herrenschmidt * GNU General Public License for more details.
139f4a8a2dSBenjamin Herrenschmidt */
149f4a8a2dSBenjamin Herrenschmidt
159f4a8a2dSBenjamin Herrenschmidt #include <linux/device.h>
169f4a8a2dSBenjamin Herrenschmidt #include <linux/errno.h>
179f4a8a2dSBenjamin Herrenschmidt #include <linux/fs.h>
189f4a8a2dSBenjamin Herrenschmidt #include <linux/fsi.h>
199f4a8a2dSBenjamin Herrenschmidt #include <linux/fsi-sbefifo.h>
209f4a8a2dSBenjamin Herrenschmidt #include <linux/kernel.h>
218b052dd6SBenjamin Herrenschmidt #include <linux/cdev.h>
229f4a8a2dSBenjamin Herrenschmidt #include <linux/module.h>
239f4a8a2dSBenjamin Herrenschmidt #include <linux/mutex.h>
249f4a8a2dSBenjamin Herrenschmidt #include <linux/of.h>
259f4a8a2dSBenjamin Herrenschmidt #include <linux/of_platform.h>
26288f1acfSRob Herring #include <linux/platform_device.h>
279f4a8a2dSBenjamin Herrenschmidt #include <linux/sched.h>
289f4a8a2dSBenjamin Herrenschmidt #include <linux/slab.h>
299f4a8a2dSBenjamin Herrenschmidt #include <linux/uaccess.h>
309f4a8a2dSBenjamin Herrenschmidt #include <linux/delay.h>
319f4a8a2dSBenjamin Herrenschmidt #include <linux/uio.h>
329f4a8a2dSBenjamin Herrenschmidt #include <linux/vmalloc.h>
3315e2a721SBenjamin Herrenschmidt #include <linux/mm.h>
349f4a8a2dSBenjamin Herrenschmidt
35a1dc6308SAmitay Isaacs #include <uapi/linux/fsi.h>
36a1dc6308SAmitay Isaacs
379f4a8a2dSBenjamin Herrenschmidt /*
389f4a8a2dSBenjamin Herrenschmidt * The SBEFIFO is a pipe-like FSI device for communicating with
399f4a8a2dSBenjamin Herrenschmidt * the self boot engine on POWER processors.
409f4a8a2dSBenjamin Herrenschmidt */
419f4a8a2dSBenjamin Herrenschmidt
429f4a8a2dSBenjamin Herrenschmidt #define DEVICE_NAME "sbefifo"
439f4a8a2dSBenjamin Herrenschmidt #define FSI_ENGID_SBE 0x22
449f4a8a2dSBenjamin Herrenschmidt
459f4a8a2dSBenjamin Herrenschmidt /*
469f4a8a2dSBenjamin Herrenschmidt * Register layout
479f4a8a2dSBenjamin Herrenschmidt */
489f4a8a2dSBenjamin Herrenschmidt
499f4a8a2dSBenjamin Herrenschmidt /* Register banks */
509f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_UP 0x00 /* FSI -> Host */
519f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_DOWN 0x40 /* Host -> FSI */
529f4a8a2dSBenjamin Herrenschmidt
539f4a8a2dSBenjamin Herrenschmidt /* Per-bank registers */
549f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_FIFO 0x00 /* The FIFO itself */
559f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_STS 0x04 /* Status register */
569f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_STS_PARITY_ERR 0x20000000
579f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_STS_RESET_REQ 0x02000000
589f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_STS_GOT_EOT 0x00800000
599f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_STS_MAX_XFER_LIMIT 0x00400000
609f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_STS_FULL 0x00200000
619f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_STS_EMPTY 0x00100000
629f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_STS_ECNT_MASK 0x000f0000
639f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_STS_ECNT_SHIFT 16
649f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_STS_VALID_MASK 0x0000ff00
659f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_STS_VALID_SHIFT 8
669f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_STS_EOT_MASK 0x000000ff
679f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_STS_EOT_SHIFT 0
689f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_EOT_RAISE 0x08 /* (Up only) Set End Of Transfer */
699f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_REQ_RESET 0x0C /* (Up only) Reset Request */
709f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_PERFORM_RESET 0x10 /* (Down only) Perform Reset */
719f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_EOT_ACK 0x14 /* (Down only) Acknowledge EOT */
729f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_DOWN_MAX 0x18 /* (Down only) Max transfer */
739f4a8a2dSBenjamin Herrenschmidt
749f4a8a2dSBenjamin Herrenschmidt /* CFAM GP Mailbox SelfBoot Message register */
759f4a8a2dSBenjamin Herrenschmidt #define CFAM_GP_MBOX_SBM_ADDR 0x2824 /* Converted 0x2809 */
769f4a8a2dSBenjamin Herrenschmidt
779f4a8a2dSBenjamin Herrenschmidt #define CFAM_SBM_SBE_BOOTED 0x80000000
789f4a8a2dSBenjamin Herrenschmidt #define CFAM_SBM_SBE_ASYNC_FFDC 0x40000000
799f4a8a2dSBenjamin Herrenschmidt #define CFAM_SBM_SBE_STATE_MASK 0x00f00000
809f4a8a2dSBenjamin Herrenschmidt #define CFAM_SBM_SBE_STATE_SHIFT 20
819f4a8a2dSBenjamin Herrenschmidt
829f4a8a2dSBenjamin Herrenschmidt enum sbe_state
839f4a8a2dSBenjamin Herrenschmidt {
84*f04d61a3SYu Zhe SBE_STATE_UNKNOWN = 0x0, // Unknown, initial state
859f4a8a2dSBenjamin Herrenschmidt SBE_STATE_IPLING = 0x1, // IPL'ing - autonomous mode (transient)
869f4a8a2dSBenjamin Herrenschmidt SBE_STATE_ISTEP = 0x2, // ISTEP - Running IPL by steps (transient)
879f4a8a2dSBenjamin Herrenschmidt SBE_STATE_MPIPL = 0x3, // MPIPL
889f4a8a2dSBenjamin Herrenschmidt SBE_STATE_RUNTIME = 0x4, // SBE Runtime
899f4a8a2dSBenjamin Herrenschmidt SBE_STATE_DMT = 0x5, // Dead Man Timer State (transient)
909f4a8a2dSBenjamin Herrenschmidt SBE_STATE_DUMP = 0x6, // Dumping
919f4a8a2dSBenjamin Herrenschmidt SBE_STATE_FAILURE = 0x7, // Internal SBE failure
929f4a8a2dSBenjamin Herrenschmidt SBE_STATE_QUIESCE = 0x8, // Final state - needs SBE reset to get out
939f4a8a2dSBenjamin Herrenschmidt };
949f4a8a2dSBenjamin Herrenschmidt
959f4a8a2dSBenjamin Herrenschmidt /* FIFO depth */
969f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_FIFO_DEPTH 8
979f4a8a2dSBenjamin Herrenschmidt
989f4a8a2dSBenjamin Herrenschmidt /* Helpers */
999f4a8a2dSBenjamin Herrenschmidt #define sbefifo_empty(sts) ((sts) & SBEFIFO_STS_EMPTY)
1009f4a8a2dSBenjamin Herrenschmidt #define sbefifo_full(sts) ((sts) & SBEFIFO_STS_FULL)
1019f4a8a2dSBenjamin Herrenschmidt #define sbefifo_parity_err(sts) ((sts) & SBEFIFO_STS_PARITY_ERR)
1029f4a8a2dSBenjamin Herrenschmidt #define sbefifo_populated(sts) (((sts) & SBEFIFO_STS_ECNT_MASK) >> SBEFIFO_STS_ECNT_SHIFT)
1039f4a8a2dSBenjamin Herrenschmidt #define sbefifo_vacant(sts) (SBEFIFO_FIFO_DEPTH - sbefifo_populated(sts))
1049f4a8a2dSBenjamin Herrenschmidt #define sbefifo_eot_set(sts) (((sts) & SBEFIFO_STS_EOT_MASK) >> SBEFIFO_STS_EOT_SHIFT)
1059f4a8a2dSBenjamin Herrenschmidt
1069f4a8a2dSBenjamin Herrenschmidt /* Reset request timeout in ms */
1079f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_RESET_TIMEOUT 10000
1089f4a8a2dSBenjamin Herrenschmidt
1099f4a8a2dSBenjamin Herrenschmidt /* Timeouts for commands in ms */
1109f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_TIMEOUT_START_CMD 10000
1119f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_TIMEOUT_IN_CMD 1000
1129f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_TIMEOUT_START_RSP 10000
1139f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_TIMEOUT_IN_RSP 1000
1149f4a8a2dSBenjamin Herrenschmidt
1159f4a8a2dSBenjamin Herrenschmidt /* Other constants */
11615e2a721SBenjamin Herrenschmidt #define SBEFIFO_MAX_USER_CMD_LEN (0x100000 + PAGE_SIZE)
1179f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_RESET_MAGIC 0x52534554 /* "RSET" */
1189f4a8a2dSBenjamin Herrenschmidt
1199f4a8a2dSBenjamin Herrenschmidt struct sbefifo {
1209f4a8a2dSBenjamin Herrenschmidt uint32_t magic;
1219f4a8a2dSBenjamin Herrenschmidt #define SBEFIFO_MAGIC 0x53424546 /* "SBEF" */
1229f4a8a2dSBenjamin Herrenschmidt struct fsi_device *fsi_dev;
1238b052dd6SBenjamin Herrenschmidt struct device dev;
1248b052dd6SBenjamin Herrenschmidt struct cdev cdev;
1259f4a8a2dSBenjamin Herrenschmidt struct mutex lock;
1269f4a8a2dSBenjamin Herrenschmidt bool broken;
1278b052dd6SBenjamin Herrenschmidt bool dead;
1289f4a8a2dSBenjamin Herrenschmidt bool async_ffdc;
12982628034SEddie James bool timed_out;
13019c064deSEddie James u32 timeout_in_cmd_ms;
131b8d536d2SAmitay Isaacs u32 timeout_start_rsp_ms;
1329f4a8a2dSBenjamin Herrenschmidt };
1339f4a8a2dSBenjamin Herrenschmidt
1349f4a8a2dSBenjamin Herrenschmidt struct sbefifo_user {
1359f4a8a2dSBenjamin Herrenschmidt struct sbefifo *sbefifo;
1369f4a8a2dSBenjamin Herrenschmidt struct mutex file_lock;
13715e2a721SBenjamin Herrenschmidt void *cmd_page;
1389f4a8a2dSBenjamin Herrenschmidt void *pending_cmd;
1399f4a8a2dSBenjamin Herrenschmidt size_t pending_len;
14019c064deSEddie James u32 cmd_timeout_ms;
141a1dc6308SAmitay Isaacs u32 read_timeout_ms;
1429f4a8a2dSBenjamin Herrenschmidt };
1439f4a8a2dSBenjamin Herrenschmidt
1449f4a8a2dSBenjamin Herrenschmidt static DEFINE_MUTEX(sbefifo_ffdc_mutex);
1459f4a8a2dSBenjamin Herrenschmidt
timeout_show(struct device * dev,struct device_attribute * attr,char * buf)14682628034SEddie James static ssize_t timeout_show(struct device *dev, struct device_attribute *attr,
14782628034SEddie James char *buf)
14882628034SEddie James {
14982628034SEddie James struct sbefifo *sbefifo = container_of(dev, struct sbefifo, dev);
15082628034SEddie James
15182628034SEddie James return sysfs_emit(buf, "%d\n", sbefifo->timed_out ? 1 : 0);
15282628034SEddie James }
15382628034SEddie James static DEVICE_ATTR_RO(timeout);
1548b052dd6SBenjamin Herrenschmidt
__sbefifo_dump_ffdc(struct device * dev,const __be32 * ffdc,size_t ffdc_sz,bool internal)1554fcdc2d1SBenjamin Herrenschmidt static void __sbefifo_dump_ffdc(struct device *dev, const __be32 *ffdc,
1569f4a8a2dSBenjamin Herrenschmidt size_t ffdc_sz, bool internal)
1579f4a8a2dSBenjamin Herrenschmidt {
1589f4a8a2dSBenjamin Herrenschmidt int pack = 0;
1599f4a8a2dSBenjamin Herrenschmidt #define FFDC_LSIZE 60
1609f4a8a2dSBenjamin Herrenschmidt static char ffdc_line[FFDC_LSIZE];
1619f4a8a2dSBenjamin Herrenschmidt char *p = ffdc_line;
1629f4a8a2dSBenjamin Herrenschmidt
1639f4a8a2dSBenjamin Herrenschmidt while (ffdc_sz) {
1649f4a8a2dSBenjamin Herrenschmidt u32 w0, w1, w2, i;
1659f4a8a2dSBenjamin Herrenschmidt if (ffdc_sz < 3) {
1669f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "SBE invalid FFDC package size %zd\n", ffdc_sz);
1679f4a8a2dSBenjamin Herrenschmidt return;
1689f4a8a2dSBenjamin Herrenschmidt }
1699f4a8a2dSBenjamin Herrenschmidt w0 = be32_to_cpu(*(ffdc++));
1709f4a8a2dSBenjamin Herrenschmidt w1 = be32_to_cpu(*(ffdc++));
1719f4a8a2dSBenjamin Herrenschmidt w2 = be32_to_cpu(*(ffdc++));
1729f4a8a2dSBenjamin Herrenschmidt ffdc_sz -= 3;
1739f4a8a2dSBenjamin Herrenschmidt if ((w0 >> 16) != 0xFFDC) {
1749f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "SBE invalid FFDC package signature %08x %08x %08x\n",
1759f4a8a2dSBenjamin Herrenschmidt w0, w1, w2);
1769f4a8a2dSBenjamin Herrenschmidt break;
1779f4a8a2dSBenjamin Herrenschmidt }
1789f4a8a2dSBenjamin Herrenschmidt w0 &= 0xffff;
1799f4a8a2dSBenjamin Herrenschmidt if (w0 > ffdc_sz) {
1809f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "SBE FFDC package len %d words but only %zd remaining\n",
1819f4a8a2dSBenjamin Herrenschmidt w0, ffdc_sz);
1829f4a8a2dSBenjamin Herrenschmidt w0 = ffdc_sz;
1839f4a8a2dSBenjamin Herrenschmidt break;
1849f4a8a2dSBenjamin Herrenschmidt }
1859f4a8a2dSBenjamin Herrenschmidt if (internal) {
1869f4a8a2dSBenjamin Herrenschmidt dev_warn(dev, "+---- SBE FFDC package %d for async err -----+\n",
1879f4a8a2dSBenjamin Herrenschmidt pack++);
1889f4a8a2dSBenjamin Herrenschmidt } else {
1899f4a8a2dSBenjamin Herrenschmidt dev_warn(dev, "+---- SBE FFDC package %d for cmd %02x:%02x -----+\n",
1909f4a8a2dSBenjamin Herrenschmidt pack++, (w1 >> 8) & 0xff, w1 & 0xff);
1919f4a8a2dSBenjamin Herrenschmidt }
1929f4a8a2dSBenjamin Herrenschmidt dev_warn(dev, "| Response code: %08x |\n", w2);
1939f4a8a2dSBenjamin Herrenschmidt dev_warn(dev, "|-------------------------------------------|\n");
1949f4a8a2dSBenjamin Herrenschmidt for (i = 0; i < w0; i++) {
1959f4a8a2dSBenjamin Herrenschmidt if ((i & 3) == 0) {
1969f4a8a2dSBenjamin Herrenschmidt p = ffdc_line;
1979f4a8a2dSBenjamin Herrenschmidt p += sprintf(p, "| %04x:", i << 4);
1989f4a8a2dSBenjamin Herrenschmidt }
1999f4a8a2dSBenjamin Herrenschmidt p += sprintf(p, " %08x", be32_to_cpu(*(ffdc++)));
2009f4a8a2dSBenjamin Herrenschmidt ffdc_sz--;
2019f4a8a2dSBenjamin Herrenschmidt if ((i & 3) == 3 || i == (w0 - 1)) {
2029f4a8a2dSBenjamin Herrenschmidt while ((i & 3) < 3) {
2039f4a8a2dSBenjamin Herrenschmidt p += sprintf(p, " ");
2049f4a8a2dSBenjamin Herrenschmidt i++;
2059f4a8a2dSBenjamin Herrenschmidt }
2069f4a8a2dSBenjamin Herrenschmidt dev_warn(dev, "%s |\n", ffdc_line);
2079f4a8a2dSBenjamin Herrenschmidt }
2089f4a8a2dSBenjamin Herrenschmidt }
2099f4a8a2dSBenjamin Herrenschmidt dev_warn(dev, "+-------------------------------------------+\n");
2109f4a8a2dSBenjamin Herrenschmidt }
2114fcdc2d1SBenjamin Herrenschmidt }
2124fcdc2d1SBenjamin Herrenschmidt
sbefifo_dump_ffdc(struct device * dev,const __be32 * ffdc,size_t ffdc_sz,bool internal)2134fcdc2d1SBenjamin Herrenschmidt static void sbefifo_dump_ffdc(struct device *dev, const __be32 *ffdc,
2144fcdc2d1SBenjamin Herrenschmidt size_t ffdc_sz, bool internal)
2154fcdc2d1SBenjamin Herrenschmidt {
2164fcdc2d1SBenjamin Herrenschmidt mutex_lock(&sbefifo_ffdc_mutex);
2174fcdc2d1SBenjamin Herrenschmidt __sbefifo_dump_ffdc(dev, ffdc, ffdc_sz, internal);
218c00bac88SEddie James mutex_unlock(&sbefifo_ffdc_mutex);
2199f4a8a2dSBenjamin Herrenschmidt }
2209f4a8a2dSBenjamin Herrenschmidt
sbefifo_parse_status(struct device * dev,u16 cmd,__be32 * response,size_t resp_len,size_t * data_len)2219f4a8a2dSBenjamin Herrenschmidt int sbefifo_parse_status(struct device *dev, u16 cmd, __be32 *response,
2229f4a8a2dSBenjamin Herrenschmidt size_t resp_len, size_t *data_len)
2239f4a8a2dSBenjamin Herrenschmidt {
2249f4a8a2dSBenjamin Herrenschmidt u32 dh, s0, s1;
2259f4a8a2dSBenjamin Herrenschmidt size_t ffdc_sz;
2269f4a8a2dSBenjamin Herrenschmidt
2279f4a8a2dSBenjamin Herrenschmidt if (resp_len < 3) {
2289f4a8a2dSBenjamin Herrenschmidt pr_debug("sbefifo: cmd %04x, response too small: %zd\n",
2299f4a8a2dSBenjamin Herrenschmidt cmd, resp_len);
2309f4a8a2dSBenjamin Herrenschmidt return -ENXIO;
2319f4a8a2dSBenjamin Herrenschmidt }
2329f4a8a2dSBenjamin Herrenschmidt dh = be32_to_cpu(response[resp_len - 1]);
2339f4a8a2dSBenjamin Herrenschmidt if (dh > resp_len || dh < 3) {
2349f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "SBE cmd %02x:%02x status offset out of range: %d/%zd\n",
2359f4a8a2dSBenjamin Herrenschmidt cmd >> 8, cmd & 0xff, dh, resp_len);
2369f4a8a2dSBenjamin Herrenschmidt return -ENXIO;
2379f4a8a2dSBenjamin Herrenschmidt }
2389f4a8a2dSBenjamin Herrenschmidt s0 = be32_to_cpu(response[resp_len - dh]);
2399f4a8a2dSBenjamin Herrenschmidt s1 = be32_to_cpu(response[resp_len - dh + 1]);
2409f4a8a2dSBenjamin Herrenschmidt if (((s0 >> 16) != 0xC0DE) || ((s0 & 0xffff) != cmd)) {
2419f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "SBE cmd %02x:%02x, status signature invalid: 0x%08x 0x%08x\n",
2429f4a8a2dSBenjamin Herrenschmidt cmd >> 8, cmd & 0xff, s0, s1);
2439f4a8a2dSBenjamin Herrenschmidt return -ENXIO;
2449f4a8a2dSBenjamin Herrenschmidt }
2459f4a8a2dSBenjamin Herrenschmidt if (s1 != 0) {
2469f4a8a2dSBenjamin Herrenschmidt ffdc_sz = dh - 3;
2479f4a8a2dSBenjamin Herrenschmidt dev_warn(dev, "SBE error cmd %02x:%02x status=%04x:%04x\n",
2489f4a8a2dSBenjamin Herrenschmidt cmd >> 8, cmd & 0xff, s1 >> 16, s1 & 0xffff);
2499f4a8a2dSBenjamin Herrenschmidt if (ffdc_sz)
2509f4a8a2dSBenjamin Herrenschmidt sbefifo_dump_ffdc(dev, &response[resp_len - dh + 2],
2519f4a8a2dSBenjamin Herrenschmidt ffdc_sz, false);
2529f4a8a2dSBenjamin Herrenschmidt }
2539f4a8a2dSBenjamin Herrenschmidt if (data_len)
2549f4a8a2dSBenjamin Herrenschmidt *data_len = resp_len - dh;
2559f4a8a2dSBenjamin Herrenschmidt
2569f4a8a2dSBenjamin Herrenschmidt /*
2579f4a8a2dSBenjamin Herrenschmidt * Primary status don't have the top bit set, so can't be confused with
2589f4a8a2dSBenjamin Herrenschmidt * Linux negative error codes, so return the status word whole.
2599f4a8a2dSBenjamin Herrenschmidt */
2609f4a8a2dSBenjamin Herrenschmidt return s1;
2619f4a8a2dSBenjamin Herrenschmidt }
2629f4a8a2dSBenjamin Herrenschmidt EXPORT_SYMBOL_GPL(sbefifo_parse_status);
2639f4a8a2dSBenjamin Herrenschmidt
sbefifo_regr(struct sbefifo * sbefifo,int reg,u32 * word)2649f4a8a2dSBenjamin Herrenschmidt static int sbefifo_regr(struct sbefifo *sbefifo, int reg, u32 *word)
2659f4a8a2dSBenjamin Herrenschmidt {
2669f4a8a2dSBenjamin Herrenschmidt __be32 raw_word;
2679f4a8a2dSBenjamin Herrenschmidt int rc;
2689f4a8a2dSBenjamin Herrenschmidt
2699f4a8a2dSBenjamin Herrenschmidt rc = fsi_device_read(sbefifo->fsi_dev, reg, &raw_word,
2709f4a8a2dSBenjamin Herrenschmidt sizeof(raw_word));
2719f4a8a2dSBenjamin Herrenschmidt if (rc)
2729f4a8a2dSBenjamin Herrenschmidt return rc;
2739f4a8a2dSBenjamin Herrenschmidt
2749f4a8a2dSBenjamin Herrenschmidt *word = be32_to_cpu(raw_word);
2759f4a8a2dSBenjamin Herrenschmidt
2769f4a8a2dSBenjamin Herrenschmidt return 0;
2779f4a8a2dSBenjamin Herrenschmidt }
2789f4a8a2dSBenjamin Herrenschmidt
sbefifo_regw(struct sbefifo * sbefifo,int reg,u32 word)2799f4a8a2dSBenjamin Herrenschmidt static int sbefifo_regw(struct sbefifo *sbefifo, int reg, u32 word)
2809f4a8a2dSBenjamin Herrenschmidt {
2819f4a8a2dSBenjamin Herrenschmidt __be32 raw_word = cpu_to_be32(word);
2829f4a8a2dSBenjamin Herrenschmidt
2839f4a8a2dSBenjamin Herrenschmidt return fsi_device_write(sbefifo->fsi_dev, reg, &raw_word,
2849f4a8a2dSBenjamin Herrenschmidt sizeof(raw_word));
2859f4a8a2dSBenjamin Herrenschmidt }
2869f4a8a2dSBenjamin Herrenschmidt
sbefifo_check_sbe_state(struct sbefifo * sbefifo)2879f4a8a2dSBenjamin Herrenschmidt static int sbefifo_check_sbe_state(struct sbefifo *sbefifo)
2889f4a8a2dSBenjamin Herrenschmidt {
2899f4a8a2dSBenjamin Herrenschmidt __be32 raw_word;
2909f4a8a2dSBenjamin Herrenschmidt u32 sbm;
2919f4a8a2dSBenjamin Herrenschmidt int rc;
2929f4a8a2dSBenjamin Herrenschmidt
2939f4a8a2dSBenjamin Herrenschmidt rc = fsi_slave_read(sbefifo->fsi_dev->slave, CFAM_GP_MBOX_SBM_ADDR,
2949f4a8a2dSBenjamin Herrenschmidt &raw_word, sizeof(raw_word));
2959f4a8a2dSBenjamin Herrenschmidt if (rc)
2969f4a8a2dSBenjamin Herrenschmidt return rc;
2979f4a8a2dSBenjamin Herrenschmidt sbm = be32_to_cpu(raw_word);
2989f4a8a2dSBenjamin Herrenschmidt
2999f4a8a2dSBenjamin Herrenschmidt /* SBE booted at all ? */
3009f4a8a2dSBenjamin Herrenschmidt if (!(sbm & CFAM_SBM_SBE_BOOTED))
3019f4a8a2dSBenjamin Herrenschmidt return -ESHUTDOWN;
3029f4a8a2dSBenjamin Herrenschmidt
3039f4a8a2dSBenjamin Herrenschmidt /* Check its state */
3049f4a8a2dSBenjamin Herrenschmidt switch ((sbm & CFAM_SBM_SBE_STATE_MASK) >> CFAM_SBM_SBE_STATE_SHIFT) {
3059f4a8a2dSBenjamin Herrenschmidt case SBE_STATE_UNKNOWN:
3069f4a8a2dSBenjamin Herrenschmidt return -ESHUTDOWN;
3077ce98fb6SEddie James case SBE_STATE_DMT:
3087ce98fb6SEddie James return -EBUSY;
3099f4a8a2dSBenjamin Herrenschmidt case SBE_STATE_IPLING:
3109f4a8a2dSBenjamin Herrenschmidt case SBE_STATE_ISTEP:
3119f4a8a2dSBenjamin Herrenschmidt case SBE_STATE_MPIPL:
3129f4a8a2dSBenjamin Herrenschmidt case SBE_STATE_RUNTIME:
3139f4a8a2dSBenjamin Herrenschmidt case SBE_STATE_DUMP: /* Not sure about that one */
3149f4a8a2dSBenjamin Herrenschmidt break;
3159f4a8a2dSBenjamin Herrenschmidt case SBE_STATE_FAILURE:
3169f4a8a2dSBenjamin Herrenschmidt case SBE_STATE_QUIESCE:
3179f4a8a2dSBenjamin Herrenschmidt return -ESHUTDOWN;
3189f4a8a2dSBenjamin Herrenschmidt }
3199f4a8a2dSBenjamin Herrenschmidt
3209f4a8a2dSBenjamin Herrenschmidt /* Is there async FFDC available ? Remember it */
3219f4a8a2dSBenjamin Herrenschmidt if (sbm & CFAM_SBM_SBE_ASYNC_FFDC)
3229f4a8a2dSBenjamin Herrenschmidt sbefifo->async_ffdc = true;
3239f4a8a2dSBenjamin Herrenschmidt
3249f4a8a2dSBenjamin Herrenschmidt return 0;
3259f4a8a2dSBenjamin Herrenschmidt }
3269f4a8a2dSBenjamin Herrenschmidt
3279f4a8a2dSBenjamin Herrenschmidt /* Don't flip endianness of data to/from FIFO, just pass through. */
sbefifo_down_read(struct sbefifo * sbefifo,__be32 * word)3289f4a8a2dSBenjamin Herrenschmidt static int sbefifo_down_read(struct sbefifo *sbefifo, __be32 *word)
3299f4a8a2dSBenjamin Herrenschmidt {
3309f4a8a2dSBenjamin Herrenschmidt return fsi_device_read(sbefifo->fsi_dev, SBEFIFO_DOWN, word,
3319f4a8a2dSBenjamin Herrenschmidt sizeof(*word));
3329f4a8a2dSBenjamin Herrenschmidt }
3339f4a8a2dSBenjamin Herrenschmidt
sbefifo_up_write(struct sbefifo * sbefifo,__be32 word)3349f4a8a2dSBenjamin Herrenschmidt static int sbefifo_up_write(struct sbefifo *sbefifo, __be32 word)
3359f4a8a2dSBenjamin Herrenschmidt {
3369f4a8a2dSBenjamin Herrenschmidt return fsi_device_write(sbefifo->fsi_dev, SBEFIFO_UP, &word,
3379f4a8a2dSBenjamin Herrenschmidt sizeof(word));
3389f4a8a2dSBenjamin Herrenschmidt }
3399f4a8a2dSBenjamin Herrenschmidt
sbefifo_request_reset(struct sbefifo * sbefifo)3409f4a8a2dSBenjamin Herrenschmidt static int sbefifo_request_reset(struct sbefifo *sbefifo)
3419f4a8a2dSBenjamin Herrenschmidt {
3429f4a8a2dSBenjamin Herrenschmidt struct device *dev = &sbefifo->fsi_dev->dev;
3439ab1428dSJoachim Fenkes unsigned long end_time;
3449ab1428dSJoachim Fenkes u32 status;
3459f4a8a2dSBenjamin Herrenschmidt int rc;
3469f4a8a2dSBenjamin Herrenschmidt
3479f4a8a2dSBenjamin Herrenschmidt dev_dbg(dev, "Requesting FIFO reset\n");
3489f4a8a2dSBenjamin Herrenschmidt
3499f4a8a2dSBenjamin Herrenschmidt /* Mark broken first, will be cleared if reset succeeds */
3509f4a8a2dSBenjamin Herrenschmidt sbefifo->broken = true;
3519f4a8a2dSBenjamin Herrenschmidt
3529f4a8a2dSBenjamin Herrenschmidt /* Send reset request */
3539f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_regw(sbefifo, SBEFIFO_UP | SBEFIFO_REQ_RESET, 1);
3549f4a8a2dSBenjamin Herrenschmidt if (rc) {
3559f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "Sending reset request failed, rc=%d\n", rc);
3569f4a8a2dSBenjamin Herrenschmidt return rc;
3579f4a8a2dSBenjamin Herrenschmidt }
3589f4a8a2dSBenjamin Herrenschmidt
3599f4a8a2dSBenjamin Herrenschmidt /* Wait for it to complete */
3609ab1428dSJoachim Fenkes end_time = jiffies + msecs_to_jiffies(SBEFIFO_RESET_TIMEOUT);
3619ab1428dSJoachim Fenkes while (!time_after(jiffies, end_time)) {
3629f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_regr(sbefifo, SBEFIFO_UP | SBEFIFO_STS, &status);
3639f4a8a2dSBenjamin Herrenschmidt if (rc) {
3649f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "Failed to read UP fifo status during reset"
3659f4a8a2dSBenjamin Herrenschmidt " , rc=%d\n", rc);
3669f4a8a2dSBenjamin Herrenschmidt return rc;
3679f4a8a2dSBenjamin Herrenschmidt }
3689f4a8a2dSBenjamin Herrenschmidt
3699f4a8a2dSBenjamin Herrenschmidt if (!(status & SBEFIFO_STS_RESET_REQ)) {
3709f4a8a2dSBenjamin Herrenschmidt dev_dbg(dev, "FIFO reset done\n");
3719f4a8a2dSBenjamin Herrenschmidt sbefifo->broken = false;
3729f4a8a2dSBenjamin Herrenschmidt return 0;
3739f4a8a2dSBenjamin Herrenschmidt }
3749f4a8a2dSBenjamin Herrenschmidt
3759ab1428dSJoachim Fenkes cond_resched();
3769f4a8a2dSBenjamin Herrenschmidt }
3779f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "FIFO reset timed out\n");
3789f4a8a2dSBenjamin Herrenschmidt
3799f4a8a2dSBenjamin Herrenschmidt return -ETIMEDOUT;
3809f4a8a2dSBenjamin Herrenschmidt }
3819f4a8a2dSBenjamin Herrenschmidt
sbefifo_cleanup_hw(struct sbefifo * sbefifo)3829f4a8a2dSBenjamin Herrenschmidt static int sbefifo_cleanup_hw(struct sbefifo *sbefifo)
3839f4a8a2dSBenjamin Herrenschmidt {
3849f4a8a2dSBenjamin Herrenschmidt struct device *dev = &sbefifo->fsi_dev->dev;
3859f4a8a2dSBenjamin Herrenschmidt u32 up_status, down_status;
3869f4a8a2dSBenjamin Herrenschmidt bool need_reset = false;
3879f4a8a2dSBenjamin Herrenschmidt int rc;
3889f4a8a2dSBenjamin Herrenschmidt
3899f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_check_sbe_state(sbefifo);
3909f4a8a2dSBenjamin Herrenschmidt if (rc) {
3919f4a8a2dSBenjamin Herrenschmidt dev_dbg(dev, "SBE state=%d\n", rc);
3929f4a8a2dSBenjamin Herrenschmidt return rc;
3939f4a8a2dSBenjamin Herrenschmidt }
3949f4a8a2dSBenjamin Herrenschmidt
3959f4a8a2dSBenjamin Herrenschmidt /* If broken, we don't need to look at status, go straight to reset */
3969f4a8a2dSBenjamin Herrenschmidt if (sbefifo->broken)
3979f4a8a2dSBenjamin Herrenschmidt goto do_reset;
3989f4a8a2dSBenjamin Herrenschmidt
3999f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_regr(sbefifo, SBEFIFO_UP | SBEFIFO_STS, &up_status);
4009f4a8a2dSBenjamin Herrenschmidt if (rc) {
4019f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "Cleanup: Reading UP status failed, rc=%d\n", rc);
4029f4a8a2dSBenjamin Herrenschmidt
4039f4a8a2dSBenjamin Herrenschmidt /* Will try reset again on next attempt at using it */
4049f4a8a2dSBenjamin Herrenschmidt sbefifo->broken = true;
4059f4a8a2dSBenjamin Herrenschmidt return rc;
4069f4a8a2dSBenjamin Herrenschmidt }
4079f4a8a2dSBenjamin Herrenschmidt
4089f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_regr(sbefifo, SBEFIFO_DOWN | SBEFIFO_STS, &down_status);
4099f4a8a2dSBenjamin Herrenschmidt if (rc) {
4109f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "Cleanup: Reading DOWN status failed, rc=%d\n", rc);
4119f4a8a2dSBenjamin Herrenschmidt
4129f4a8a2dSBenjamin Herrenschmidt /* Will try reset again on next attempt at using it */
4139f4a8a2dSBenjamin Herrenschmidt sbefifo->broken = true;
4149f4a8a2dSBenjamin Herrenschmidt return rc;
4159f4a8a2dSBenjamin Herrenschmidt }
4169f4a8a2dSBenjamin Herrenschmidt
4179f4a8a2dSBenjamin Herrenschmidt /* The FIFO already contains a reset request from the SBE ? */
4189f4a8a2dSBenjamin Herrenschmidt if (down_status & SBEFIFO_STS_RESET_REQ) {
4199f4a8a2dSBenjamin Herrenschmidt dev_info(dev, "Cleanup: FIFO reset request set, resetting\n");
42095152433SJoachim Fenkes rc = sbefifo_regw(sbefifo, SBEFIFO_DOWN, SBEFIFO_PERFORM_RESET);
4219f4a8a2dSBenjamin Herrenschmidt if (rc) {
4229f4a8a2dSBenjamin Herrenschmidt sbefifo->broken = true;
4239f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "Cleanup: Reset reg write failed, rc=%d\n", rc);
4249f4a8a2dSBenjamin Herrenschmidt return rc;
4259f4a8a2dSBenjamin Herrenschmidt }
4269f4a8a2dSBenjamin Herrenschmidt sbefifo->broken = false;
4279f4a8a2dSBenjamin Herrenschmidt return 0;
4289f4a8a2dSBenjamin Herrenschmidt }
4299f4a8a2dSBenjamin Herrenschmidt
4309f4a8a2dSBenjamin Herrenschmidt /* Parity error on either FIFO ? */
4319f4a8a2dSBenjamin Herrenschmidt if ((up_status | down_status) & SBEFIFO_STS_PARITY_ERR)
4329f4a8a2dSBenjamin Herrenschmidt need_reset = true;
4339f4a8a2dSBenjamin Herrenschmidt
4349f4a8a2dSBenjamin Herrenschmidt /* Either FIFO not empty ? */
4359f4a8a2dSBenjamin Herrenschmidt if (!((up_status & down_status) & SBEFIFO_STS_EMPTY))
4369f4a8a2dSBenjamin Herrenschmidt need_reset = true;
4379f4a8a2dSBenjamin Herrenschmidt
4389f4a8a2dSBenjamin Herrenschmidt if (!need_reset)
4399f4a8a2dSBenjamin Herrenschmidt return 0;
4409f4a8a2dSBenjamin Herrenschmidt
4419f4a8a2dSBenjamin Herrenschmidt dev_info(dev, "Cleanup: FIFO not clean (up=0x%08x down=0x%08x)\n",
4429f4a8a2dSBenjamin Herrenschmidt up_status, down_status);
4439f4a8a2dSBenjamin Herrenschmidt
4449f4a8a2dSBenjamin Herrenschmidt do_reset:
4459f4a8a2dSBenjamin Herrenschmidt
4469f4a8a2dSBenjamin Herrenschmidt /* Mark broken, will be cleared if/when reset succeeds */
4479f4a8a2dSBenjamin Herrenschmidt return sbefifo_request_reset(sbefifo);
4489f4a8a2dSBenjamin Herrenschmidt }
4499f4a8a2dSBenjamin Herrenschmidt
sbefifo_wait(struct sbefifo * sbefifo,bool up,u32 * status,unsigned long timeout)4509f4a8a2dSBenjamin Herrenschmidt static int sbefifo_wait(struct sbefifo *sbefifo, bool up,
4519f4a8a2dSBenjamin Herrenschmidt u32 *status, unsigned long timeout)
4529f4a8a2dSBenjamin Herrenschmidt {
4539f4a8a2dSBenjamin Herrenschmidt struct device *dev = &sbefifo->fsi_dev->dev;
4549f4a8a2dSBenjamin Herrenschmidt unsigned long end_time;
4559f4a8a2dSBenjamin Herrenschmidt bool ready = false;
4569f4a8a2dSBenjamin Herrenschmidt u32 addr, sts = 0;
4579f4a8a2dSBenjamin Herrenschmidt int rc;
4589f4a8a2dSBenjamin Herrenschmidt
4599f4a8a2dSBenjamin Herrenschmidt dev_vdbg(dev, "Wait on %s fifo...\n", up ? "up" : "down");
4609f4a8a2dSBenjamin Herrenschmidt
4619f4a8a2dSBenjamin Herrenschmidt addr = (up ? SBEFIFO_UP : SBEFIFO_DOWN) | SBEFIFO_STS;
4629f4a8a2dSBenjamin Herrenschmidt
4639f4a8a2dSBenjamin Herrenschmidt end_time = jiffies + timeout;
4649f4a8a2dSBenjamin Herrenschmidt while (!time_after(jiffies, end_time)) {
4659f4a8a2dSBenjamin Herrenschmidt cond_resched();
4669f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_regr(sbefifo, addr, &sts);
4679f4a8a2dSBenjamin Herrenschmidt if (rc < 0) {
4689f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "FSI error %d reading status register\n", rc);
4699f4a8a2dSBenjamin Herrenschmidt return rc;
4709f4a8a2dSBenjamin Herrenschmidt }
4719f4a8a2dSBenjamin Herrenschmidt if (!up && sbefifo_parity_err(sts)) {
4729f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "Parity error in DOWN FIFO\n");
4739f4a8a2dSBenjamin Herrenschmidt return -ENXIO;
4749f4a8a2dSBenjamin Herrenschmidt }
4759f4a8a2dSBenjamin Herrenschmidt ready = !(up ? sbefifo_full(sts) : sbefifo_empty(sts));
4769f4a8a2dSBenjamin Herrenschmidt if (ready)
4779f4a8a2dSBenjamin Herrenschmidt break;
4789f4a8a2dSBenjamin Herrenschmidt }
4799f4a8a2dSBenjamin Herrenschmidt if (!ready) {
48082628034SEddie James sysfs_notify(&sbefifo->dev.kobj, NULL, dev_attr_timeout.attr.name);
48182628034SEddie James sbefifo->timed_out = true;
482b1534a05SJoel Stanley dev_err(dev, "%s FIFO Timeout (%u ms)! status=%08x\n",
483b1534a05SJoel Stanley up ? "UP" : "DOWN", jiffies_to_msecs(timeout), sts);
4849f4a8a2dSBenjamin Herrenschmidt return -ETIMEDOUT;
4859f4a8a2dSBenjamin Herrenschmidt }
4869f4a8a2dSBenjamin Herrenschmidt dev_vdbg(dev, "End of wait status: %08x\n", sts);
4879f4a8a2dSBenjamin Herrenschmidt
48882628034SEddie James sbefifo->timed_out = false;
4899f4a8a2dSBenjamin Herrenschmidt *status = sts;
4909f4a8a2dSBenjamin Herrenschmidt
4919f4a8a2dSBenjamin Herrenschmidt return 0;
4929f4a8a2dSBenjamin Herrenschmidt }
4939f4a8a2dSBenjamin Herrenschmidt
sbefifo_send_command(struct sbefifo * sbefifo,const __be32 * command,size_t cmd_len)4949f4a8a2dSBenjamin Herrenschmidt static int sbefifo_send_command(struct sbefifo *sbefifo,
4959f4a8a2dSBenjamin Herrenschmidt const __be32 *command, size_t cmd_len)
4969f4a8a2dSBenjamin Herrenschmidt {
4979f4a8a2dSBenjamin Herrenschmidt struct device *dev = &sbefifo->fsi_dev->dev;
4989f4a8a2dSBenjamin Herrenschmidt size_t len, chunk, vacant = 0, remaining = cmd_len;
4999f4a8a2dSBenjamin Herrenschmidt unsigned long timeout;
5009f4a8a2dSBenjamin Herrenschmidt u32 status;
5019f4a8a2dSBenjamin Herrenschmidt int rc;
5029f4a8a2dSBenjamin Herrenschmidt
503b1534a05SJoel Stanley dev_dbg(dev, "sending command (%zd words, cmd=%04x)\n",
5049f4a8a2dSBenjamin Herrenschmidt cmd_len, be32_to_cpu(command[1]));
5059f4a8a2dSBenjamin Herrenschmidt
5069f4a8a2dSBenjamin Herrenschmidt /* As long as there's something to send */
5079f4a8a2dSBenjamin Herrenschmidt timeout = msecs_to_jiffies(SBEFIFO_TIMEOUT_START_CMD);
5089f4a8a2dSBenjamin Herrenschmidt while (remaining) {
5099f4a8a2dSBenjamin Herrenschmidt /* Wait for room in the FIFO */
5109f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_wait(sbefifo, true, &status, timeout);
5119f4a8a2dSBenjamin Herrenschmidt if (rc < 0)
5129f4a8a2dSBenjamin Herrenschmidt return rc;
51319c064deSEddie James timeout = msecs_to_jiffies(sbefifo->timeout_in_cmd_ms);
5149f4a8a2dSBenjamin Herrenschmidt
5159f4a8a2dSBenjamin Herrenschmidt vacant = sbefifo_vacant(status);
5169f4a8a2dSBenjamin Herrenschmidt len = chunk = min(vacant, remaining);
5179f4a8a2dSBenjamin Herrenschmidt
5189f4a8a2dSBenjamin Herrenschmidt dev_vdbg(dev, " status=%08x vacant=%zd chunk=%zd\n",
5199f4a8a2dSBenjamin Herrenschmidt status, vacant, chunk);
5209f4a8a2dSBenjamin Herrenschmidt
5219f4a8a2dSBenjamin Herrenschmidt /* Write as much as we can */
5229f4a8a2dSBenjamin Herrenschmidt while (len--) {
5239f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_up_write(sbefifo, *(command++));
5249f4a8a2dSBenjamin Herrenschmidt if (rc) {
5259f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "FSI error %d writing UP FIFO\n", rc);
5269f4a8a2dSBenjamin Herrenschmidt return rc;
5279f4a8a2dSBenjamin Herrenschmidt }
5289f4a8a2dSBenjamin Herrenschmidt }
5299f4a8a2dSBenjamin Herrenschmidt remaining -= chunk;
5309f4a8a2dSBenjamin Herrenschmidt vacant -= chunk;
5319f4a8a2dSBenjamin Herrenschmidt }
5329f4a8a2dSBenjamin Herrenschmidt
5339f4a8a2dSBenjamin Herrenschmidt /* If there's no room left, wait for some to write EOT */
5349f4a8a2dSBenjamin Herrenschmidt if (!vacant) {
5359f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_wait(sbefifo, true, &status, timeout);
5369f4a8a2dSBenjamin Herrenschmidt if (rc)
5379f4a8a2dSBenjamin Herrenschmidt return rc;
5389f4a8a2dSBenjamin Herrenschmidt }
5399f4a8a2dSBenjamin Herrenschmidt
5409f4a8a2dSBenjamin Herrenschmidt /* Send an EOT */
5419f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_regw(sbefifo, SBEFIFO_UP | SBEFIFO_EOT_RAISE, 0);
5429f4a8a2dSBenjamin Herrenschmidt if (rc)
5439f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "FSI error %d writing EOT\n", rc);
5449f4a8a2dSBenjamin Herrenschmidt return rc;
5459f4a8a2dSBenjamin Herrenschmidt }
5469f4a8a2dSBenjamin Herrenschmidt
sbefifo_read_response(struct sbefifo * sbefifo,struct iov_iter * response)5479f4a8a2dSBenjamin Herrenschmidt static int sbefifo_read_response(struct sbefifo *sbefifo, struct iov_iter *response)
5489f4a8a2dSBenjamin Herrenschmidt {
5499f4a8a2dSBenjamin Herrenschmidt struct device *dev = &sbefifo->fsi_dev->dev;
55029925138SJoel Stanley u32 status, eot_set;
5519f4a8a2dSBenjamin Herrenschmidt unsigned long timeout;
5529f4a8a2dSBenjamin Herrenschmidt bool overflow = false;
55329925138SJoel Stanley __be32 data;
5549f4a8a2dSBenjamin Herrenschmidt size_t len;
5559f4a8a2dSBenjamin Herrenschmidt int rc;
5569f4a8a2dSBenjamin Herrenschmidt
557b1534a05SJoel Stanley dev_dbg(dev, "reading response, buflen = %zd\n", iov_iter_count(response));
5589f4a8a2dSBenjamin Herrenschmidt
559b8d536d2SAmitay Isaacs timeout = msecs_to_jiffies(sbefifo->timeout_start_rsp_ms);
5609f4a8a2dSBenjamin Herrenschmidt for (;;) {
5619f4a8a2dSBenjamin Herrenschmidt /* Grab FIFO status (this will handle parity errors) */
5629f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_wait(sbefifo, false, &status, timeout);
563b1534a05SJoel Stanley if (rc < 0) {
564b1534a05SJoel Stanley dev_dbg(dev, "timeout waiting (%u ms)\n", jiffies_to_msecs(timeout));
5659f4a8a2dSBenjamin Herrenschmidt return rc;
566b1534a05SJoel Stanley }
5679f4a8a2dSBenjamin Herrenschmidt timeout = msecs_to_jiffies(SBEFIFO_TIMEOUT_IN_RSP);
5689f4a8a2dSBenjamin Herrenschmidt
5699f4a8a2dSBenjamin Herrenschmidt /* Decode status */
5709f4a8a2dSBenjamin Herrenschmidt len = sbefifo_populated(status);
5719f4a8a2dSBenjamin Herrenschmidt eot_set = sbefifo_eot_set(status);
5729f4a8a2dSBenjamin Herrenschmidt
573b1534a05SJoel Stanley dev_dbg(dev, " chunk size %zd eot_set=0x%x\n", len, eot_set);
5749f4a8a2dSBenjamin Herrenschmidt
5759f4a8a2dSBenjamin Herrenschmidt /* Go through the chunk */
5769f4a8a2dSBenjamin Herrenschmidt while(len--) {
5779f4a8a2dSBenjamin Herrenschmidt /* Read the data */
5789f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_down_read(sbefifo, &data);
5799f4a8a2dSBenjamin Herrenschmidt if (rc < 0)
5809f4a8a2dSBenjamin Herrenschmidt return rc;
5819f4a8a2dSBenjamin Herrenschmidt
5829f4a8a2dSBenjamin Herrenschmidt /* Was it an EOT ? */
5839f4a8a2dSBenjamin Herrenschmidt if (eot_set & 0x80) {
5849f4a8a2dSBenjamin Herrenschmidt /*
5859f4a8a2dSBenjamin Herrenschmidt * There should be nothing else in the FIFO,
5869f4a8a2dSBenjamin Herrenschmidt * if there is, mark broken, this will force
5879f4a8a2dSBenjamin Herrenschmidt * a reset on next use, but don't fail the
5889f4a8a2dSBenjamin Herrenschmidt * command.
5899f4a8a2dSBenjamin Herrenschmidt */
5909f4a8a2dSBenjamin Herrenschmidt if (len) {
5919f4a8a2dSBenjamin Herrenschmidt dev_warn(dev, "FIFO read hit"
5929f4a8a2dSBenjamin Herrenschmidt " EOT with still %zd data\n",
5939f4a8a2dSBenjamin Herrenschmidt len);
5949f4a8a2dSBenjamin Herrenschmidt sbefifo->broken = true;
5959f4a8a2dSBenjamin Herrenschmidt }
5969f4a8a2dSBenjamin Herrenschmidt
5979f4a8a2dSBenjamin Herrenschmidt /* We are done */
5989f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_regw(sbefifo,
5999f4a8a2dSBenjamin Herrenschmidt SBEFIFO_DOWN | SBEFIFO_EOT_ACK, 0);
6009f4a8a2dSBenjamin Herrenschmidt
6019f4a8a2dSBenjamin Herrenschmidt /*
6029f4a8a2dSBenjamin Herrenschmidt * If that write fail, still complete the request but mark
6039f4a8a2dSBenjamin Herrenschmidt * the fifo as broken for subsequent reset (not much else
6049f4a8a2dSBenjamin Herrenschmidt * we can do here).
6059f4a8a2dSBenjamin Herrenschmidt */
6069f4a8a2dSBenjamin Herrenschmidt if (rc) {
6079f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "FSI error %d ack'ing EOT\n", rc);
6089f4a8a2dSBenjamin Herrenschmidt sbefifo->broken = true;
6099f4a8a2dSBenjamin Herrenschmidt }
6109f4a8a2dSBenjamin Herrenschmidt
6119f4a8a2dSBenjamin Herrenschmidt /* Tell whether we overflowed */
6129f4a8a2dSBenjamin Herrenschmidt return overflow ? -EOVERFLOW : 0;
6139f4a8a2dSBenjamin Herrenschmidt }
6149f4a8a2dSBenjamin Herrenschmidt
6159f4a8a2dSBenjamin Herrenschmidt /* Store it if there is room */
6169f4a8a2dSBenjamin Herrenschmidt if (iov_iter_count(response) >= sizeof(__be32)) {
6179f4a8a2dSBenjamin Herrenschmidt if (copy_to_iter(&data, sizeof(__be32), response) < sizeof(__be32))
6189f4a8a2dSBenjamin Herrenschmidt return -EFAULT;
6199f4a8a2dSBenjamin Herrenschmidt } else {
6209f4a8a2dSBenjamin Herrenschmidt dev_vdbg(dev, "Response overflowed !\n");
6219f4a8a2dSBenjamin Herrenschmidt
6229f4a8a2dSBenjamin Herrenschmidt overflow = true;
6239f4a8a2dSBenjamin Herrenschmidt }
6249f4a8a2dSBenjamin Herrenschmidt
6259f4a8a2dSBenjamin Herrenschmidt /* Next EOT bit */
6269f4a8a2dSBenjamin Herrenschmidt eot_set <<= 1;
6279f4a8a2dSBenjamin Herrenschmidt }
6289f4a8a2dSBenjamin Herrenschmidt }
6299f4a8a2dSBenjamin Herrenschmidt /* Shouldn't happen */
6309f4a8a2dSBenjamin Herrenschmidt return -EIO;
6319f4a8a2dSBenjamin Herrenschmidt }
6329f4a8a2dSBenjamin Herrenschmidt
sbefifo_do_command(struct sbefifo * sbefifo,const __be32 * command,size_t cmd_len,struct iov_iter * response)6339f4a8a2dSBenjamin Herrenschmidt static int sbefifo_do_command(struct sbefifo *sbefifo,
6349f4a8a2dSBenjamin Herrenschmidt const __be32 *command, size_t cmd_len,
6359f4a8a2dSBenjamin Herrenschmidt struct iov_iter *response)
6369f4a8a2dSBenjamin Herrenschmidt {
6379f4a8a2dSBenjamin Herrenschmidt /* Try sending the command */
6389f4a8a2dSBenjamin Herrenschmidt int rc = sbefifo_send_command(sbefifo, command, cmd_len);
6399f4a8a2dSBenjamin Herrenschmidt if (rc)
6409f4a8a2dSBenjamin Herrenschmidt return rc;
6419f4a8a2dSBenjamin Herrenschmidt
6429f4a8a2dSBenjamin Herrenschmidt /* Now, get the response */
6439f4a8a2dSBenjamin Herrenschmidt return sbefifo_read_response(sbefifo, response);
6449f4a8a2dSBenjamin Herrenschmidt }
6459f4a8a2dSBenjamin Herrenschmidt
sbefifo_collect_async_ffdc(struct sbefifo * sbefifo)6469f4a8a2dSBenjamin Herrenschmidt static void sbefifo_collect_async_ffdc(struct sbefifo *sbefifo)
6479f4a8a2dSBenjamin Herrenschmidt {
6489f4a8a2dSBenjamin Herrenschmidt struct device *dev = &sbefifo->fsi_dev->dev;
6499f4a8a2dSBenjamin Herrenschmidt struct iov_iter ffdc_iter;
6509f4a8a2dSBenjamin Herrenschmidt struct kvec ffdc_iov;
6519f4a8a2dSBenjamin Herrenschmidt __be32 *ffdc;
6529f4a8a2dSBenjamin Herrenschmidt size_t ffdc_sz;
65329925138SJoel Stanley __be32 cmd[2];
6549f4a8a2dSBenjamin Herrenschmidt int rc;
6559f4a8a2dSBenjamin Herrenschmidt
6569f4a8a2dSBenjamin Herrenschmidt sbefifo->async_ffdc = false;
6579f4a8a2dSBenjamin Herrenschmidt ffdc = vmalloc(SBEFIFO_MAX_FFDC_SIZE);
6589f4a8a2dSBenjamin Herrenschmidt if (!ffdc) {
6599f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "Failed to allocate SBE FFDC buffer\n");
6609f4a8a2dSBenjamin Herrenschmidt return;
6619f4a8a2dSBenjamin Herrenschmidt }
6629f4a8a2dSBenjamin Herrenschmidt ffdc_iov.iov_base = ffdc;
663a9ef97d0SBenjamin Herrenschmidt ffdc_iov.iov_len = SBEFIFO_MAX_FFDC_SIZE;
664de4eda9dSAl Viro iov_iter_kvec(&ffdc_iter, ITER_DEST, &ffdc_iov, 1, SBEFIFO_MAX_FFDC_SIZE);
6659f4a8a2dSBenjamin Herrenschmidt cmd[0] = cpu_to_be32(2);
6669f4a8a2dSBenjamin Herrenschmidt cmd[1] = cpu_to_be32(SBEFIFO_CMD_GET_SBE_FFDC);
6679f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_do_command(sbefifo, cmd, 2, &ffdc_iter);
6689f4a8a2dSBenjamin Herrenschmidt if (rc != 0) {
6699f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "Error %d retrieving SBE FFDC\n", rc);
6709f4a8a2dSBenjamin Herrenschmidt goto bail;
6719f4a8a2dSBenjamin Herrenschmidt }
6729f4a8a2dSBenjamin Herrenschmidt ffdc_sz = SBEFIFO_MAX_FFDC_SIZE - iov_iter_count(&ffdc_iter);
6739f4a8a2dSBenjamin Herrenschmidt ffdc_sz /= sizeof(__be32);
6749f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_parse_status(dev, SBEFIFO_CMD_GET_SBE_FFDC, ffdc,
6759f4a8a2dSBenjamin Herrenschmidt ffdc_sz, &ffdc_sz);
6769f4a8a2dSBenjamin Herrenschmidt if (rc != 0) {
6779f4a8a2dSBenjamin Herrenschmidt dev_err(dev, "Error %d decoding SBE FFDC\n", rc);
6789f4a8a2dSBenjamin Herrenschmidt goto bail;
6799f4a8a2dSBenjamin Herrenschmidt }
6809f4a8a2dSBenjamin Herrenschmidt if (ffdc_sz > 0)
6819f4a8a2dSBenjamin Herrenschmidt sbefifo_dump_ffdc(dev, ffdc, ffdc_sz, true);
6829f4a8a2dSBenjamin Herrenschmidt bail:
6839f4a8a2dSBenjamin Herrenschmidt vfree(ffdc);
6849f4a8a2dSBenjamin Herrenschmidt
6859f4a8a2dSBenjamin Herrenschmidt }
6869f4a8a2dSBenjamin Herrenschmidt
__sbefifo_submit(struct sbefifo * sbefifo,const __be32 * command,size_t cmd_len,struct iov_iter * response)6879f4a8a2dSBenjamin Herrenschmidt static int __sbefifo_submit(struct sbefifo *sbefifo,
6889f4a8a2dSBenjamin Herrenschmidt const __be32 *command, size_t cmd_len,
6899f4a8a2dSBenjamin Herrenschmidt struct iov_iter *response)
6909f4a8a2dSBenjamin Herrenschmidt {
6919f4a8a2dSBenjamin Herrenschmidt struct device *dev = &sbefifo->fsi_dev->dev;
6929f4a8a2dSBenjamin Herrenschmidt int rc;
6939f4a8a2dSBenjamin Herrenschmidt
6948b052dd6SBenjamin Herrenschmidt if (sbefifo->dead)
6958b052dd6SBenjamin Herrenschmidt return -ENODEV;
6968b052dd6SBenjamin Herrenschmidt
6979f4a8a2dSBenjamin Herrenschmidt if (cmd_len < 2 || be32_to_cpu(command[0]) != cmd_len) {
6989f4a8a2dSBenjamin Herrenschmidt dev_vdbg(dev, "Invalid command len %zd (header: %d)\n",
6999f4a8a2dSBenjamin Herrenschmidt cmd_len, be32_to_cpu(command[0]));
7009f4a8a2dSBenjamin Herrenschmidt return -EINVAL;
7019f4a8a2dSBenjamin Herrenschmidt }
7029f4a8a2dSBenjamin Herrenschmidt
7039f4a8a2dSBenjamin Herrenschmidt /* First ensure the HW is in a clean state */
7049f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_cleanup_hw(sbefifo);
7059f4a8a2dSBenjamin Herrenschmidt if (rc)
7069f4a8a2dSBenjamin Herrenschmidt return rc;
7079f4a8a2dSBenjamin Herrenschmidt
7089f4a8a2dSBenjamin Herrenschmidt /* Look for async FFDC first if any */
7099f4a8a2dSBenjamin Herrenschmidt if (sbefifo->async_ffdc)
7109f4a8a2dSBenjamin Herrenschmidt sbefifo_collect_async_ffdc(sbefifo);
7119f4a8a2dSBenjamin Herrenschmidt
7129f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_do_command(sbefifo, command, cmd_len, response);
7139f4a8a2dSBenjamin Herrenschmidt if (rc != 0 && rc != -EOVERFLOW)
7149f4a8a2dSBenjamin Herrenschmidt goto fail;
7159f4a8a2dSBenjamin Herrenschmidt return rc;
7169f4a8a2dSBenjamin Herrenschmidt fail:
7179f4a8a2dSBenjamin Herrenschmidt /*
7189f4a8a2dSBenjamin Herrenschmidt * On failure, attempt a reset. Ignore the result, it will mark
7199f4a8a2dSBenjamin Herrenschmidt * the fifo broken if the reset fails
7209f4a8a2dSBenjamin Herrenschmidt */
7219f4a8a2dSBenjamin Herrenschmidt sbefifo_request_reset(sbefifo);
7229f4a8a2dSBenjamin Herrenschmidt
7239f4a8a2dSBenjamin Herrenschmidt /* Return original error */
7249f4a8a2dSBenjamin Herrenschmidt return rc;
7259f4a8a2dSBenjamin Herrenschmidt }
7269f4a8a2dSBenjamin Herrenschmidt
7279f4a8a2dSBenjamin Herrenschmidt /**
7289f4a8a2dSBenjamin Herrenschmidt * sbefifo_submit() - Submit and SBE fifo command and receive response
7299f4a8a2dSBenjamin Herrenschmidt * @dev: The sbefifo device
7309f4a8a2dSBenjamin Herrenschmidt * @command: The raw command data
7319f4a8a2dSBenjamin Herrenschmidt * @cmd_len: The command size (in 32-bit words)
7329f4a8a2dSBenjamin Herrenschmidt * @response: The output response buffer
7339f4a8a2dSBenjamin Herrenschmidt * @resp_len: In: Response buffer size, Out: Response size
7349f4a8a2dSBenjamin Herrenschmidt *
735*f04d61a3SYu Zhe * This will perform the entire operation. If the response buffer
7369f4a8a2dSBenjamin Herrenschmidt * overflows, returns -EOVERFLOW
7379f4a8a2dSBenjamin Herrenschmidt */
sbefifo_submit(struct device * dev,const __be32 * command,size_t cmd_len,__be32 * response,size_t * resp_len)7389f4a8a2dSBenjamin Herrenschmidt int sbefifo_submit(struct device *dev, const __be32 *command, size_t cmd_len,
7399f4a8a2dSBenjamin Herrenschmidt __be32 *response, size_t *resp_len)
7409f4a8a2dSBenjamin Herrenschmidt {
741d5c66e61SBenjamin Herrenschmidt struct sbefifo *sbefifo;
7429f4a8a2dSBenjamin Herrenschmidt struct iov_iter resp_iter;
7439f4a8a2dSBenjamin Herrenschmidt struct kvec resp_iov;
7449f4a8a2dSBenjamin Herrenschmidt size_t rbytes;
7459f4a8a2dSBenjamin Herrenschmidt int rc;
7469f4a8a2dSBenjamin Herrenschmidt
747d5c66e61SBenjamin Herrenschmidt if (!dev)
748d5c66e61SBenjamin Herrenschmidt return -ENODEV;
749d5c66e61SBenjamin Herrenschmidt sbefifo = dev_get_drvdata(dev);
750d5c66e61SBenjamin Herrenschmidt if (!sbefifo)
7519f4a8a2dSBenjamin Herrenschmidt return -ENODEV;
7529f4a8a2dSBenjamin Herrenschmidt if (WARN_ON_ONCE(sbefifo->magic != SBEFIFO_MAGIC))
7539f4a8a2dSBenjamin Herrenschmidt return -ENODEV;
75415e2a721SBenjamin Herrenschmidt if (!resp_len || !command || !response)
7559f4a8a2dSBenjamin Herrenschmidt return -EINVAL;
7569f4a8a2dSBenjamin Herrenschmidt
7579f4a8a2dSBenjamin Herrenschmidt /* Prepare iov iterator */
7589f4a8a2dSBenjamin Herrenschmidt rbytes = (*resp_len) * sizeof(__be32);
7599f4a8a2dSBenjamin Herrenschmidt resp_iov.iov_base = response;
7609f4a8a2dSBenjamin Herrenschmidt resp_iov.iov_len = rbytes;
761de4eda9dSAl Viro iov_iter_kvec(&resp_iter, ITER_DEST, &resp_iov, 1, rbytes);
7629f4a8a2dSBenjamin Herrenschmidt
7639f4a8a2dSBenjamin Herrenschmidt /* Perform the command */
7647cc2f34eSEddie James rc = mutex_lock_interruptible(&sbefifo->lock);
7657cc2f34eSEddie James if (rc)
7667cc2f34eSEddie James return rc;
7679f4a8a2dSBenjamin Herrenschmidt rc = __sbefifo_submit(sbefifo, command, cmd_len, &resp_iter);
7689f4a8a2dSBenjamin Herrenschmidt mutex_unlock(&sbefifo->lock);
7699f4a8a2dSBenjamin Herrenschmidt
7709f4a8a2dSBenjamin Herrenschmidt /* Extract the response length */
7719f4a8a2dSBenjamin Herrenschmidt rbytes -= iov_iter_count(&resp_iter);
7729f4a8a2dSBenjamin Herrenschmidt *resp_len = rbytes / sizeof(__be32);
7739f4a8a2dSBenjamin Herrenschmidt
7749f4a8a2dSBenjamin Herrenschmidt return rc;
7759f4a8a2dSBenjamin Herrenschmidt }
7769f4a8a2dSBenjamin Herrenschmidt EXPORT_SYMBOL_GPL(sbefifo_submit);
7779f4a8a2dSBenjamin Herrenschmidt
7789f4a8a2dSBenjamin Herrenschmidt /*
7799f4a8a2dSBenjamin Herrenschmidt * Char device interface
7809f4a8a2dSBenjamin Herrenschmidt */
78115e2a721SBenjamin Herrenschmidt
sbefifo_release_command(struct sbefifo_user * user)78215e2a721SBenjamin Herrenschmidt static void sbefifo_release_command(struct sbefifo_user *user)
78315e2a721SBenjamin Herrenschmidt {
78415e2a721SBenjamin Herrenschmidt if (is_vmalloc_addr(user->pending_cmd))
78515e2a721SBenjamin Herrenschmidt vfree(user->pending_cmd);
78615e2a721SBenjamin Herrenschmidt user->pending_cmd = NULL;
78715e2a721SBenjamin Herrenschmidt user->pending_len = 0;
78815e2a721SBenjamin Herrenschmidt }
78915e2a721SBenjamin Herrenschmidt
sbefifo_user_open(struct inode * inode,struct file * file)7909f4a8a2dSBenjamin Herrenschmidt static int sbefifo_user_open(struct inode *inode, struct file *file)
7919f4a8a2dSBenjamin Herrenschmidt {
7928b052dd6SBenjamin Herrenschmidt struct sbefifo *sbefifo = container_of(inode->i_cdev, struct sbefifo, cdev);
7939f4a8a2dSBenjamin Herrenschmidt struct sbefifo_user *user;
7949f4a8a2dSBenjamin Herrenschmidt
7959f4a8a2dSBenjamin Herrenschmidt user = kzalloc(sizeof(struct sbefifo_user), GFP_KERNEL);
7969f4a8a2dSBenjamin Herrenschmidt if (!user)
7979f4a8a2dSBenjamin Herrenschmidt return -ENOMEM;
7989f4a8a2dSBenjamin Herrenschmidt
7999f4a8a2dSBenjamin Herrenschmidt file->private_data = user;
8009f4a8a2dSBenjamin Herrenschmidt user->sbefifo = sbefifo;
80115e2a721SBenjamin Herrenschmidt user->cmd_page = (void *)__get_free_page(GFP_KERNEL);
80215e2a721SBenjamin Herrenschmidt if (!user->cmd_page) {
8039f4a8a2dSBenjamin Herrenschmidt kfree(user);
8049f4a8a2dSBenjamin Herrenschmidt return -ENOMEM;
8059f4a8a2dSBenjamin Herrenschmidt }
8069f4a8a2dSBenjamin Herrenschmidt mutex_init(&user->file_lock);
80719c064deSEddie James user->cmd_timeout_ms = SBEFIFO_TIMEOUT_IN_CMD;
808a1dc6308SAmitay Isaacs user->read_timeout_ms = SBEFIFO_TIMEOUT_START_RSP;
8099f4a8a2dSBenjamin Herrenschmidt
8109f4a8a2dSBenjamin Herrenschmidt return 0;
8119f4a8a2dSBenjamin Herrenschmidt }
8129f4a8a2dSBenjamin Herrenschmidt
sbefifo_user_read(struct file * file,char __user * buf,size_t len,loff_t * offset)8139f4a8a2dSBenjamin Herrenschmidt static ssize_t sbefifo_user_read(struct file *file, char __user *buf,
8149f4a8a2dSBenjamin Herrenschmidt size_t len, loff_t *offset)
8159f4a8a2dSBenjamin Herrenschmidt {
8169f4a8a2dSBenjamin Herrenschmidt struct sbefifo_user *user = file->private_data;
8179f4a8a2dSBenjamin Herrenschmidt struct sbefifo *sbefifo;
8189f4a8a2dSBenjamin Herrenschmidt struct iov_iter resp_iter;
8199f4a8a2dSBenjamin Herrenschmidt struct iovec resp_iov;
8209f4a8a2dSBenjamin Herrenschmidt size_t cmd_len;
8219f4a8a2dSBenjamin Herrenschmidt int rc;
8229f4a8a2dSBenjamin Herrenschmidt
8239f4a8a2dSBenjamin Herrenschmidt if (!user)
8249f4a8a2dSBenjamin Herrenschmidt return -EINVAL;
8259f4a8a2dSBenjamin Herrenschmidt sbefifo = user->sbefifo;
8269f4a8a2dSBenjamin Herrenschmidt if (len & 3)
8279f4a8a2dSBenjamin Herrenschmidt return -EINVAL;
8289f4a8a2dSBenjamin Herrenschmidt
8299f4a8a2dSBenjamin Herrenschmidt mutex_lock(&user->file_lock);
8309f4a8a2dSBenjamin Herrenschmidt
8319f4a8a2dSBenjamin Herrenschmidt /* Cronus relies on -EAGAIN after a short read */
8329f4a8a2dSBenjamin Herrenschmidt if (user->pending_len == 0) {
8339f4a8a2dSBenjamin Herrenschmidt rc = -EAGAIN;
8349f4a8a2dSBenjamin Herrenschmidt goto bail;
8359f4a8a2dSBenjamin Herrenschmidt }
8369f4a8a2dSBenjamin Herrenschmidt if (user->pending_len < 8) {
8379f4a8a2dSBenjamin Herrenschmidt rc = -EINVAL;
8389f4a8a2dSBenjamin Herrenschmidt goto bail;
8399f4a8a2dSBenjamin Herrenschmidt }
8409f4a8a2dSBenjamin Herrenschmidt cmd_len = user->pending_len >> 2;
8419f4a8a2dSBenjamin Herrenschmidt
8429f4a8a2dSBenjamin Herrenschmidt /* Prepare iov iterator */
8439f4a8a2dSBenjamin Herrenschmidt resp_iov.iov_base = buf;
8449f4a8a2dSBenjamin Herrenschmidt resp_iov.iov_len = len;
845de4eda9dSAl Viro iov_iter_init(&resp_iter, ITER_DEST, &resp_iov, 1, len);
8469f4a8a2dSBenjamin Herrenschmidt
8479f4a8a2dSBenjamin Herrenschmidt /* Perform the command */
8487cc2f34eSEddie James rc = mutex_lock_interruptible(&sbefifo->lock);
8497cc2f34eSEddie James if (rc)
8507cc2f34eSEddie James goto bail;
85119c064deSEddie James sbefifo->timeout_in_cmd_ms = user->cmd_timeout_ms;
852a1dc6308SAmitay Isaacs sbefifo->timeout_start_rsp_ms = user->read_timeout_ms;
8539f4a8a2dSBenjamin Herrenschmidt rc = __sbefifo_submit(sbefifo, user->pending_cmd, cmd_len, &resp_iter);
854a1dc6308SAmitay Isaacs sbefifo->timeout_start_rsp_ms = SBEFIFO_TIMEOUT_START_RSP;
85519c064deSEddie James sbefifo->timeout_in_cmd_ms = SBEFIFO_TIMEOUT_IN_CMD;
8569f4a8a2dSBenjamin Herrenschmidt mutex_unlock(&sbefifo->lock);
8579f4a8a2dSBenjamin Herrenschmidt if (rc < 0)
8589f4a8a2dSBenjamin Herrenschmidt goto bail;
8599f4a8a2dSBenjamin Herrenschmidt
8609f4a8a2dSBenjamin Herrenschmidt /* Extract the response length */
8619f4a8a2dSBenjamin Herrenschmidt rc = len - iov_iter_count(&resp_iter);
8629f4a8a2dSBenjamin Herrenschmidt bail:
86315e2a721SBenjamin Herrenschmidt sbefifo_release_command(user);
8649f4a8a2dSBenjamin Herrenschmidt mutex_unlock(&user->file_lock);
8659f4a8a2dSBenjamin Herrenschmidt return rc;
8669f4a8a2dSBenjamin Herrenschmidt }
8679f4a8a2dSBenjamin Herrenschmidt
sbefifo_user_write(struct file * file,const char __user * buf,size_t len,loff_t * offset)8689f4a8a2dSBenjamin Herrenschmidt static ssize_t sbefifo_user_write(struct file *file, const char __user *buf,
8699f4a8a2dSBenjamin Herrenschmidt size_t len, loff_t *offset)
8709f4a8a2dSBenjamin Herrenschmidt {
8719f4a8a2dSBenjamin Herrenschmidt struct sbefifo_user *user = file->private_data;
8729f4a8a2dSBenjamin Herrenschmidt struct sbefifo *sbefifo;
8739f4a8a2dSBenjamin Herrenschmidt int rc = len;
8749f4a8a2dSBenjamin Herrenschmidt
8759f4a8a2dSBenjamin Herrenschmidt if (!user)
8769f4a8a2dSBenjamin Herrenschmidt return -EINVAL;
8779f4a8a2dSBenjamin Herrenschmidt sbefifo = user->sbefifo;
87815e2a721SBenjamin Herrenschmidt if (len > SBEFIFO_MAX_USER_CMD_LEN)
8799f4a8a2dSBenjamin Herrenschmidt return -EINVAL;
8809f4a8a2dSBenjamin Herrenschmidt if (len & 3)
8819f4a8a2dSBenjamin Herrenschmidt return -EINVAL;
8829f4a8a2dSBenjamin Herrenschmidt
8839f4a8a2dSBenjamin Herrenschmidt mutex_lock(&user->file_lock);
8849f4a8a2dSBenjamin Herrenschmidt
88515e2a721SBenjamin Herrenschmidt /* Can we use the pre-allocate buffer ? If not, allocate */
88615e2a721SBenjamin Herrenschmidt if (len <= PAGE_SIZE)
88715e2a721SBenjamin Herrenschmidt user->pending_cmd = user->cmd_page;
88815e2a721SBenjamin Herrenschmidt else
88915e2a721SBenjamin Herrenschmidt user->pending_cmd = vmalloc(len);
89015e2a721SBenjamin Herrenschmidt if (!user->pending_cmd) {
89115e2a721SBenjamin Herrenschmidt rc = -ENOMEM;
89215e2a721SBenjamin Herrenschmidt goto bail;
89315e2a721SBenjamin Herrenschmidt }
89415e2a721SBenjamin Herrenschmidt
8959f4a8a2dSBenjamin Herrenschmidt /* Copy the command into the staging buffer */
8969f4a8a2dSBenjamin Herrenschmidt if (copy_from_user(user->pending_cmd, buf, len)) {
8979f4a8a2dSBenjamin Herrenschmidt rc = -EFAULT;
8989f4a8a2dSBenjamin Herrenschmidt goto bail;
8999f4a8a2dSBenjamin Herrenschmidt }
9009f4a8a2dSBenjamin Herrenschmidt
9019f4a8a2dSBenjamin Herrenschmidt /* Check for the magic reset command */
9029f4a8a2dSBenjamin Herrenschmidt if (len == 4 && be32_to_cpu(*(__be32 *)user->pending_cmd) ==
9039f4a8a2dSBenjamin Herrenschmidt SBEFIFO_RESET_MAGIC) {
9049f4a8a2dSBenjamin Herrenschmidt
9059f4a8a2dSBenjamin Herrenschmidt /* Clear out any pending command */
9069f4a8a2dSBenjamin Herrenschmidt user->pending_len = 0;
9079f4a8a2dSBenjamin Herrenschmidt
9089f4a8a2dSBenjamin Herrenschmidt /* Trigger reset request */
9097cc2f34eSEddie James rc = mutex_lock_interruptible(&sbefifo->lock);
9107cc2f34eSEddie James if (rc)
9117cc2f34eSEddie James goto bail;
9129f4a8a2dSBenjamin Herrenschmidt rc = sbefifo_request_reset(user->sbefifo);
9139f4a8a2dSBenjamin Herrenschmidt mutex_unlock(&sbefifo->lock);
9149f4a8a2dSBenjamin Herrenschmidt if (rc == 0)
9159f4a8a2dSBenjamin Herrenschmidt rc = 4;
9169f4a8a2dSBenjamin Herrenschmidt goto bail;
9179f4a8a2dSBenjamin Herrenschmidt }
9189f4a8a2dSBenjamin Herrenschmidt
9199f4a8a2dSBenjamin Herrenschmidt /* Update the staging buffer size */
9209f4a8a2dSBenjamin Herrenschmidt user->pending_len = len;
9219f4a8a2dSBenjamin Herrenschmidt bail:
92215e2a721SBenjamin Herrenschmidt if (!user->pending_len)
92315e2a721SBenjamin Herrenschmidt sbefifo_release_command(user);
92415e2a721SBenjamin Herrenschmidt
9259f4a8a2dSBenjamin Herrenschmidt mutex_unlock(&user->file_lock);
9269f4a8a2dSBenjamin Herrenschmidt
9279f4a8a2dSBenjamin Herrenschmidt /* And that's it, we'll issue the command on a read */
9289f4a8a2dSBenjamin Herrenschmidt return rc;
9299f4a8a2dSBenjamin Herrenschmidt }
9309f4a8a2dSBenjamin Herrenschmidt
sbefifo_user_release(struct inode * inode,struct file * file)9319f4a8a2dSBenjamin Herrenschmidt static int sbefifo_user_release(struct inode *inode, struct file *file)
9329f4a8a2dSBenjamin Herrenschmidt {
9339f4a8a2dSBenjamin Herrenschmidt struct sbefifo_user *user = file->private_data;
9349f4a8a2dSBenjamin Herrenschmidt
9359f4a8a2dSBenjamin Herrenschmidt if (!user)
9369f4a8a2dSBenjamin Herrenschmidt return -EINVAL;
9379f4a8a2dSBenjamin Herrenschmidt
93815e2a721SBenjamin Herrenschmidt sbefifo_release_command(user);
93915e2a721SBenjamin Herrenschmidt free_page((unsigned long)user->cmd_page);
9409f4a8a2dSBenjamin Herrenschmidt kfree(user);
9419f4a8a2dSBenjamin Herrenschmidt
9429f4a8a2dSBenjamin Herrenschmidt return 0;
9439f4a8a2dSBenjamin Herrenschmidt }
9449f4a8a2dSBenjamin Herrenschmidt
sbefifo_cmd_timeout(struct sbefifo_user * user,void __user * argp)94519c064deSEddie James static int sbefifo_cmd_timeout(struct sbefifo_user *user, void __user *argp)
94619c064deSEddie James {
94719c064deSEddie James struct device *dev = &user->sbefifo->dev;
94819c064deSEddie James u32 timeout;
94919c064deSEddie James
95019c064deSEddie James if (get_user(timeout, (__u32 __user *)argp))
95119c064deSEddie James return -EFAULT;
95219c064deSEddie James
95319c064deSEddie James if (timeout == 0) {
95419c064deSEddie James user->cmd_timeout_ms = SBEFIFO_TIMEOUT_IN_CMD;
95519c064deSEddie James dev_dbg(dev, "Command timeout reset to %us\n", user->cmd_timeout_ms / 1000);
95619c064deSEddie James return 0;
95719c064deSEddie James }
95819c064deSEddie James
95919c064deSEddie James user->cmd_timeout_ms = timeout * 1000; /* user timeout is in sec */
96019c064deSEddie James dev_dbg(dev, "Command timeout set to %us\n", timeout);
96119c064deSEddie James return 0;
96219c064deSEddie James }
96319c064deSEddie James
sbefifo_read_timeout(struct sbefifo_user * user,void __user * argp)964a1dc6308SAmitay Isaacs static int sbefifo_read_timeout(struct sbefifo_user *user, void __user *argp)
965a1dc6308SAmitay Isaacs {
966a1dc6308SAmitay Isaacs struct device *dev = &user->sbefifo->dev;
967a1dc6308SAmitay Isaacs u32 timeout;
968a1dc6308SAmitay Isaacs
969a1dc6308SAmitay Isaacs if (get_user(timeout, (__u32 __user *)argp))
970a1dc6308SAmitay Isaacs return -EFAULT;
971a1dc6308SAmitay Isaacs
972a1dc6308SAmitay Isaacs if (timeout == 0) {
973a1dc6308SAmitay Isaacs user->read_timeout_ms = SBEFIFO_TIMEOUT_START_RSP;
9742f42220fSEddie James dev_dbg(dev, "Timeout reset to %us\n", user->read_timeout_ms / 1000);
975a1dc6308SAmitay Isaacs return 0;
976a1dc6308SAmitay Isaacs }
977a1dc6308SAmitay Isaacs
978a1dc6308SAmitay Isaacs user->read_timeout_ms = timeout * 1000; /* user timeout is in sec */
9792f42220fSEddie James dev_dbg(dev, "Timeout set to %us\n", timeout);
980a1dc6308SAmitay Isaacs return 0;
981a1dc6308SAmitay Isaacs }
982a1dc6308SAmitay Isaacs
sbefifo_user_ioctl(struct file * file,unsigned int cmd,unsigned long arg)983a1dc6308SAmitay Isaacs static long sbefifo_user_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
984a1dc6308SAmitay Isaacs {
985a1dc6308SAmitay Isaacs struct sbefifo_user *user = file->private_data;
986a1dc6308SAmitay Isaacs int rc = -ENOTTY;
987a1dc6308SAmitay Isaacs
988a1dc6308SAmitay Isaacs if (!user)
989a1dc6308SAmitay Isaacs return -EINVAL;
990a1dc6308SAmitay Isaacs
991a1dc6308SAmitay Isaacs mutex_lock(&user->file_lock);
992a1dc6308SAmitay Isaacs switch (cmd) {
99319c064deSEddie James case FSI_SBEFIFO_CMD_TIMEOUT_SECONDS:
99419c064deSEddie James rc = sbefifo_cmd_timeout(user, (void __user *)arg);
99519c064deSEddie James break;
996a1dc6308SAmitay Isaacs case FSI_SBEFIFO_READ_TIMEOUT_SECONDS:
997a1dc6308SAmitay Isaacs rc = sbefifo_read_timeout(user, (void __user *)arg);
998a1dc6308SAmitay Isaacs break;
999a1dc6308SAmitay Isaacs }
1000a1dc6308SAmitay Isaacs mutex_unlock(&user->file_lock);
1001a1dc6308SAmitay Isaacs return rc;
1002a1dc6308SAmitay Isaacs }
1003a1dc6308SAmitay Isaacs
10049f4a8a2dSBenjamin Herrenschmidt static const struct file_operations sbefifo_fops = {
10059f4a8a2dSBenjamin Herrenschmidt .owner = THIS_MODULE,
10069f4a8a2dSBenjamin Herrenschmidt .open = sbefifo_user_open,
10079f4a8a2dSBenjamin Herrenschmidt .read = sbefifo_user_read,
10089f4a8a2dSBenjamin Herrenschmidt .write = sbefifo_user_write,
10099f4a8a2dSBenjamin Herrenschmidt .release = sbefifo_user_release,
1010a1dc6308SAmitay Isaacs .unlocked_ioctl = sbefifo_user_ioctl,
10119f4a8a2dSBenjamin Herrenschmidt };
10129f4a8a2dSBenjamin Herrenschmidt
sbefifo_free(struct device * dev)10138b052dd6SBenjamin Herrenschmidt static void sbefifo_free(struct device *dev)
10148b052dd6SBenjamin Herrenschmidt {
10158b052dd6SBenjamin Herrenschmidt struct sbefifo *sbefifo = container_of(dev, struct sbefifo, dev);
10168b052dd6SBenjamin Herrenschmidt
10178b052dd6SBenjamin Herrenschmidt put_device(&sbefifo->fsi_dev->dev);
10188b052dd6SBenjamin Herrenschmidt kfree(sbefifo);
10198b052dd6SBenjamin Herrenschmidt }
10208b052dd6SBenjamin Herrenschmidt
10219f4a8a2dSBenjamin Herrenschmidt /*
10229f4a8a2dSBenjamin Herrenschmidt * Probe/remove
10239f4a8a2dSBenjamin Herrenschmidt */
10249f4a8a2dSBenjamin Herrenschmidt
sbefifo_probe(struct device * dev)10259f4a8a2dSBenjamin Herrenschmidt static int sbefifo_probe(struct device *dev)
10269f4a8a2dSBenjamin Herrenschmidt {
10279f4a8a2dSBenjamin Herrenschmidt struct fsi_device *fsi_dev = to_fsi_dev(dev);
10289f4a8a2dSBenjamin Herrenschmidt struct sbefifo *sbefifo;
10299f4a8a2dSBenjamin Herrenschmidt struct device_node *np;
10309f4a8a2dSBenjamin Herrenschmidt struct platform_device *child;
10319f4a8a2dSBenjamin Herrenschmidt char child_name[32];
10328b052dd6SBenjamin Herrenschmidt int rc, didx, child_idx = 0;
10339f4a8a2dSBenjamin Herrenschmidt
10349f4a8a2dSBenjamin Herrenschmidt dev_dbg(dev, "Found sbefifo device\n");
10359f4a8a2dSBenjamin Herrenschmidt
10368b052dd6SBenjamin Herrenschmidt sbefifo = kzalloc(sizeof(*sbefifo), GFP_KERNEL);
10379f4a8a2dSBenjamin Herrenschmidt if (!sbefifo)
10389f4a8a2dSBenjamin Herrenschmidt return -ENOMEM;
10398b052dd6SBenjamin Herrenschmidt
10408b052dd6SBenjamin Herrenschmidt /* Grab a reference to the device (parent of our cdev), we'll drop it later */
10418b052dd6SBenjamin Herrenschmidt if (!get_device(dev)) {
10428b052dd6SBenjamin Herrenschmidt kfree(sbefifo);
10438b052dd6SBenjamin Herrenschmidt return -ENODEV;
10448b052dd6SBenjamin Herrenschmidt }
10458b052dd6SBenjamin Herrenschmidt
10469f4a8a2dSBenjamin Herrenschmidt sbefifo->magic = SBEFIFO_MAGIC;
10479f4a8a2dSBenjamin Herrenschmidt sbefifo->fsi_dev = fsi_dev;
10488b052dd6SBenjamin Herrenschmidt dev_set_drvdata(dev, sbefifo);
10499f4a8a2dSBenjamin Herrenschmidt mutex_init(&sbefifo->lock);
105019c064deSEddie James sbefifo->timeout_in_cmd_ms = SBEFIFO_TIMEOUT_IN_CMD;
1051b8d536d2SAmitay Isaacs sbefifo->timeout_start_rsp_ms = SBEFIFO_TIMEOUT_START_RSP;
10529f4a8a2dSBenjamin Herrenschmidt
10538b052dd6SBenjamin Herrenschmidt /* Create chardev for userspace access */
10548b052dd6SBenjamin Herrenschmidt sbefifo->dev.type = &fsi_cdev_type;
10558b052dd6SBenjamin Herrenschmidt sbefifo->dev.parent = dev;
10568b052dd6SBenjamin Herrenschmidt sbefifo->dev.release = sbefifo_free;
10578b052dd6SBenjamin Herrenschmidt device_initialize(&sbefifo->dev);
10589f4a8a2dSBenjamin Herrenschmidt
10598b052dd6SBenjamin Herrenschmidt /* Allocate a minor in the FSI space */
10608b052dd6SBenjamin Herrenschmidt rc = fsi_get_new_minor(fsi_dev, fsi_dev_sbefifo, &sbefifo->dev.devt, &didx);
10618b052dd6SBenjamin Herrenschmidt if (rc)
10628b052dd6SBenjamin Herrenschmidt goto err;
10639f4a8a2dSBenjamin Herrenschmidt
10648b052dd6SBenjamin Herrenschmidt dev_set_name(&sbefifo->dev, "sbefifo%d", didx);
10658b052dd6SBenjamin Herrenschmidt cdev_init(&sbefifo->cdev, &sbefifo_fops);
10668b052dd6SBenjamin Herrenschmidt rc = cdev_device_add(&sbefifo->cdev, &sbefifo->dev);
10679f4a8a2dSBenjamin Herrenschmidt if (rc) {
10688b052dd6SBenjamin Herrenschmidt dev_err(dev, "Error %d creating char device %s\n",
10698b052dd6SBenjamin Herrenschmidt rc, dev_name(&sbefifo->dev));
10708b052dd6SBenjamin Herrenschmidt goto err_free_minor;
10719f4a8a2dSBenjamin Herrenschmidt }
10729f4a8a2dSBenjamin Herrenschmidt
10739f4a8a2dSBenjamin Herrenschmidt /* Create platform devs for dts child nodes (occ, etc) */
10749f4a8a2dSBenjamin Herrenschmidt for_each_available_child_of_node(dev->of_node, np) {
10759f4a8a2dSBenjamin Herrenschmidt snprintf(child_name, sizeof(child_name), "%s-dev%d",
10768b052dd6SBenjamin Herrenschmidt dev_name(&sbefifo->dev), child_idx++);
10779f4a8a2dSBenjamin Herrenschmidt child = of_platform_device_create(np, child_name, dev);
10789f4a8a2dSBenjamin Herrenschmidt if (!child)
10799f4a8a2dSBenjamin Herrenschmidt dev_warn(dev, "failed to create child %s dev\n",
10809f4a8a2dSBenjamin Herrenschmidt child_name);
10819f4a8a2dSBenjamin Herrenschmidt }
10829f4a8a2dSBenjamin Herrenschmidt
108382628034SEddie James device_create_file(&sbefifo->dev, &dev_attr_timeout);
108482628034SEddie James
10859f4a8a2dSBenjamin Herrenschmidt return 0;
10868b052dd6SBenjamin Herrenschmidt err_free_minor:
10878b052dd6SBenjamin Herrenschmidt fsi_free_minor(sbefifo->dev.devt);
10888b052dd6SBenjamin Herrenschmidt err:
10898b052dd6SBenjamin Herrenschmidt put_device(&sbefifo->dev);
10908b052dd6SBenjamin Herrenschmidt return rc;
10919f4a8a2dSBenjamin Herrenschmidt }
10929f4a8a2dSBenjamin Herrenschmidt
sbefifo_unregister_child(struct device * dev,void * data)10939f4a8a2dSBenjamin Herrenschmidt static int sbefifo_unregister_child(struct device *dev, void *data)
10949f4a8a2dSBenjamin Herrenschmidt {
10959f4a8a2dSBenjamin Herrenschmidt struct platform_device *child = to_platform_device(dev);
10969f4a8a2dSBenjamin Herrenschmidt
10979f4a8a2dSBenjamin Herrenschmidt of_device_unregister(child);
10989f4a8a2dSBenjamin Herrenschmidt if (dev->of_node)
10999f4a8a2dSBenjamin Herrenschmidt of_node_clear_flag(dev->of_node, OF_POPULATED);
11009f4a8a2dSBenjamin Herrenschmidt
11019f4a8a2dSBenjamin Herrenschmidt return 0;
11029f4a8a2dSBenjamin Herrenschmidt }
11039f4a8a2dSBenjamin Herrenschmidt
sbefifo_remove(struct device * dev)11049f4a8a2dSBenjamin Herrenschmidt static int sbefifo_remove(struct device *dev)
11059f4a8a2dSBenjamin Herrenschmidt {
11069f4a8a2dSBenjamin Herrenschmidt struct sbefifo *sbefifo = dev_get_drvdata(dev);
11079f4a8a2dSBenjamin Herrenschmidt
11089f4a8a2dSBenjamin Herrenschmidt dev_dbg(dev, "Removing sbefifo device...\n");
11099f4a8a2dSBenjamin Herrenschmidt
111082628034SEddie James device_remove_file(&sbefifo->dev, &dev_attr_timeout);
111182628034SEddie James
11128b052dd6SBenjamin Herrenschmidt mutex_lock(&sbefifo->lock);
11138b052dd6SBenjamin Herrenschmidt sbefifo->dead = true;
11148b052dd6SBenjamin Herrenschmidt mutex_unlock(&sbefifo->lock);
11159f4a8a2dSBenjamin Herrenschmidt
11168b052dd6SBenjamin Herrenschmidt cdev_device_del(&sbefifo->cdev, &sbefifo->dev);
11178b052dd6SBenjamin Herrenschmidt fsi_free_minor(sbefifo->dev.devt);
11188b052dd6SBenjamin Herrenschmidt device_for_each_child(dev, NULL, sbefifo_unregister_child);
11198b052dd6SBenjamin Herrenschmidt put_device(&sbefifo->dev);
11209f4a8a2dSBenjamin Herrenschmidt
11219f4a8a2dSBenjamin Herrenschmidt return 0;
11229f4a8a2dSBenjamin Herrenschmidt }
11239f4a8a2dSBenjamin Herrenschmidt
1124f458c38fSRikard Falkeborn static const struct fsi_device_id sbefifo_ids[] = {
11259f4a8a2dSBenjamin Herrenschmidt {
11269f4a8a2dSBenjamin Herrenschmidt .engine_type = FSI_ENGID_SBE,
11279f4a8a2dSBenjamin Herrenschmidt .version = FSI_VERSION_ANY,
11289f4a8a2dSBenjamin Herrenschmidt },
11299f4a8a2dSBenjamin Herrenschmidt { 0 }
11309f4a8a2dSBenjamin Herrenschmidt };
11319f4a8a2dSBenjamin Herrenschmidt
11329f4a8a2dSBenjamin Herrenschmidt static struct fsi_driver sbefifo_drv = {
11339f4a8a2dSBenjamin Herrenschmidt .id_table = sbefifo_ids,
11349f4a8a2dSBenjamin Herrenschmidt .drv = {
11359f4a8a2dSBenjamin Herrenschmidt .name = DEVICE_NAME,
11369f4a8a2dSBenjamin Herrenschmidt .bus = &fsi_bus_type,
11379f4a8a2dSBenjamin Herrenschmidt .probe = sbefifo_probe,
11389f4a8a2dSBenjamin Herrenschmidt .remove = sbefifo_remove,
11399f4a8a2dSBenjamin Herrenschmidt }
11409f4a8a2dSBenjamin Herrenschmidt };
11419f4a8a2dSBenjamin Herrenschmidt
sbefifo_init(void)11429f4a8a2dSBenjamin Herrenschmidt static int sbefifo_init(void)
11439f4a8a2dSBenjamin Herrenschmidt {
11449f4a8a2dSBenjamin Herrenschmidt return fsi_driver_register(&sbefifo_drv);
11459f4a8a2dSBenjamin Herrenschmidt }
11469f4a8a2dSBenjamin Herrenschmidt
sbefifo_exit(void)11479f4a8a2dSBenjamin Herrenschmidt static void sbefifo_exit(void)
11489f4a8a2dSBenjamin Herrenschmidt {
11499f4a8a2dSBenjamin Herrenschmidt fsi_driver_unregister(&sbefifo_drv);
11509f4a8a2dSBenjamin Herrenschmidt }
11519f4a8a2dSBenjamin Herrenschmidt
11529f4a8a2dSBenjamin Herrenschmidt module_init(sbefifo_init);
11539f4a8a2dSBenjamin Herrenschmidt module_exit(sbefifo_exit);
11549f4a8a2dSBenjamin Herrenschmidt MODULE_LICENSE("GPL");
11559f4a8a2dSBenjamin Herrenschmidt MODULE_AUTHOR("Brad Bishop <bradleyb@fuzziesquirrel.com>");
11569f4a8a2dSBenjamin Herrenschmidt MODULE_AUTHOR("Eddie James <eajames@linux.vnet.ibm.com>");
11579f4a8a2dSBenjamin Herrenschmidt MODULE_AUTHOR("Andrew Jeffery <andrew@aj.id.au>");
11589f4a8a2dSBenjamin Herrenschmidt MODULE_AUTHOR("Benjamin Herrenschmidt <benh@kernel.crashing.org>");
11599f4a8a2dSBenjamin Herrenschmidt MODULE_DESCRIPTION("Linux device interface to the POWER Self Boot Engine");
1160