10508ad1fSJeremy Kerr /* 20508ad1fSJeremy Kerr * FSI core driver 30508ad1fSJeremy Kerr * 40508ad1fSJeremy Kerr * Copyright (C) IBM Corporation 2016 50508ad1fSJeremy Kerr * 60508ad1fSJeremy Kerr * This program is free software; you can redistribute it and/or modify 70508ad1fSJeremy Kerr * it under the terms of the GNU General Public License version 2 as 80508ad1fSJeremy Kerr * published by the Free Software Foundation. 90508ad1fSJeremy Kerr * 100508ad1fSJeremy Kerr * This program is distributed in the hope that it will be useful, 110508ad1fSJeremy Kerr * but WITHOUT ANY WARRANTY; without even the implied warranty of 120508ad1fSJeremy Kerr * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 130508ad1fSJeremy Kerr * GNU General Public License for more details. 140508ad1fSJeremy Kerr */ 150508ad1fSJeremy Kerr 162b545cd8SJeremy Kerr #include <linux/crc4.h> 170508ad1fSJeremy Kerr #include <linux/device.h> 180508ad1fSJeremy Kerr #include <linux/fsi.h> 1909aecfabSJeremy Kerr #include <linux/idr.h> 200508ad1fSJeremy Kerr #include <linux/module.h> 212b545cd8SJeremy Kerr #include <linux/slab.h> 22f7ade2a6SJeremy Kerr #include <linux/bitops.h> 230508ad1fSJeremy Kerr 2409aecfabSJeremy Kerr #include "fsi-master.h" 2509aecfabSJeremy Kerr 26f7ade2a6SJeremy Kerr #define FSI_SLAVE_CONF_NEXT_MASK GENMASK(31, 31) 27f7ade2a6SJeremy Kerr #define FSI_SLAVE_CONF_SLOTS_MASK GENMASK(23, 16) 28f7ade2a6SJeremy Kerr #define FSI_SLAVE_CONF_SLOTS_SHIFT 16 29f7ade2a6SJeremy Kerr #define FSI_SLAVE_CONF_VERSION_MASK GENMASK(15, 12) 30f7ade2a6SJeremy Kerr #define FSI_SLAVE_CONF_VERSION_SHIFT 12 31f7ade2a6SJeremy Kerr #define FSI_SLAVE_CONF_TYPE_MASK GENMASK(11, 4) 32f7ade2a6SJeremy Kerr #define FSI_SLAVE_CONF_TYPE_SHIFT 4 33f7ade2a6SJeremy Kerr #define FSI_SLAVE_CONF_CRC_SHIFT 4 34f7ade2a6SJeremy Kerr #define FSI_SLAVE_CONF_CRC_MASK GENMASK(3, 0) 35f7ade2a6SJeremy Kerr #define FSI_SLAVE_CONF_DATA_BITS 28 36f7ade2a6SJeremy Kerr 374efe37f4SJeremy Kerr #define FSI_PEEK_BASE 0x410 384efe37f4SJeremy Kerr 39f7ade2a6SJeremy Kerr static const int engine_page_size = 0x400; 40f7ade2a6SJeremy Kerr 412b37c3e2SChristopher Bostic #define FSI_SLAVE_BASE 0x800 422b37c3e2SChristopher Bostic 432b37c3e2SChristopher Bostic /* 442b37c3e2SChristopher Bostic * FSI slave engine control register offsets 452b37c3e2SChristopher Bostic */ 462b37c3e2SChristopher Bostic #define FSI_SMODE 0x0 /* R/W: Mode register */ 472b37c3e2SChristopher Bostic 482b37c3e2SChristopher Bostic /* 492b37c3e2SChristopher Bostic * SMODE fields 502b37c3e2SChristopher Bostic */ 512b37c3e2SChristopher Bostic #define FSI_SMODE_WSC 0x80000000 /* Warm start done */ 522b37c3e2SChristopher Bostic #define FSI_SMODE_ECRC 0x20000000 /* Hw CRC check */ 532b37c3e2SChristopher Bostic #define FSI_SMODE_SID_SHIFT 24 /* ID shift */ 542b37c3e2SChristopher Bostic #define FSI_SMODE_SID_MASK 3 /* ID Mask */ 552b37c3e2SChristopher Bostic #define FSI_SMODE_ED_SHIFT 20 /* Echo delay shift */ 562b37c3e2SChristopher Bostic #define FSI_SMODE_ED_MASK 0xf /* Echo delay mask */ 572b37c3e2SChristopher Bostic #define FSI_SMODE_SD_SHIFT 16 /* Send delay shift */ 582b37c3e2SChristopher Bostic #define FSI_SMODE_SD_MASK 0xf /* Send delay mask */ 592b37c3e2SChristopher Bostic #define FSI_SMODE_LBCRR_SHIFT 8 /* Clk ratio shift */ 602b37c3e2SChristopher Bostic #define FSI_SMODE_LBCRR_MASK 0xf /* Clk ratio mask */ 612b37c3e2SChristopher Bostic 622b545cd8SJeremy Kerr #define FSI_SLAVE_SIZE_23b 0x800000 632b545cd8SJeremy Kerr 6409aecfabSJeremy Kerr static DEFINE_IDA(master_ida); 6509aecfabSJeremy Kerr 66faf0b116SJeremy Kerr struct fsi_slave { 67faf0b116SJeremy Kerr struct device dev; 68faf0b116SJeremy Kerr struct fsi_master *master; 69faf0b116SJeremy Kerr int id; 70faf0b116SJeremy Kerr int link; 71faf0b116SJeremy Kerr uint32_t size; /* size of slave address space */ 72faf0b116SJeremy Kerr }; 73faf0b116SJeremy Kerr 74cd0fdb5cSChristopher Bostic #define to_fsi_master(d) container_of(d, struct fsi_master, dev) 75faf0b116SJeremy Kerr #define to_fsi_slave(d) container_of(d, struct fsi_slave, dev) 76faf0b116SJeremy Kerr 77014c2abcSJeremy Kerr static int fsi_master_read(struct fsi_master *master, int link, 78014c2abcSJeremy Kerr uint8_t slave_id, uint32_t addr, void *val, size_t size); 79014c2abcSJeremy Kerr static int fsi_master_write(struct fsi_master *master, int link, 80014c2abcSJeremy Kerr uint8_t slave_id, uint32_t addr, const void *val, size_t size); 814efe37f4SJeremy Kerr static int fsi_slave_read(struct fsi_slave *slave, uint32_t addr, 824efe37f4SJeremy Kerr void *val, size_t size); 834efe37f4SJeremy Kerr static int fsi_slave_write(struct fsi_slave *slave, uint32_t addr, 844efe37f4SJeremy Kerr const void *val, size_t size); 85014c2abcSJeremy Kerr 864efe37f4SJeremy Kerr /* 874efe37f4SJeremy Kerr * fsi_device_read() / fsi_device_write() / fsi_device_peek() 884efe37f4SJeremy Kerr * 894efe37f4SJeremy Kerr * FSI endpoint-device support 904efe37f4SJeremy Kerr * 914efe37f4SJeremy Kerr * Read / write / peek accessors for a client 924efe37f4SJeremy Kerr * 934efe37f4SJeremy Kerr * Parameters: 944efe37f4SJeremy Kerr * dev: Structure passed to FSI client device drivers on probe(). 954efe37f4SJeremy Kerr * addr: FSI address of given device. Client should pass in its base address 964efe37f4SJeremy Kerr * plus desired offset to access its register space. 974efe37f4SJeremy Kerr * val: For read/peek this is the value read at the specified address. For 984efe37f4SJeremy Kerr * write this is value to write to the specified address. 994efe37f4SJeremy Kerr * The data in val must be FSI bus endian (big endian). 1004efe37f4SJeremy Kerr * size: Size in bytes of the operation. Sizes supported are 1, 2 and 4 bytes. 1014efe37f4SJeremy Kerr * Addresses must be aligned on size boundaries or an error will result. 1024efe37f4SJeremy Kerr */ 1034efe37f4SJeremy Kerr int fsi_device_read(struct fsi_device *dev, uint32_t addr, void *val, 1044efe37f4SJeremy Kerr size_t size) 1054efe37f4SJeremy Kerr { 1064efe37f4SJeremy Kerr if (addr > dev->size || size > dev->size || addr > dev->size - size) 1074efe37f4SJeremy Kerr return -EINVAL; 1084efe37f4SJeremy Kerr 1094efe37f4SJeremy Kerr return fsi_slave_read(dev->slave, dev->addr + addr, val, size); 1104efe37f4SJeremy Kerr } 1114efe37f4SJeremy Kerr EXPORT_SYMBOL_GPL(fsi_device_read); 1124efe37f4SJeremy Kerr 1134efe37f4SJeremy Kerr int fsi_device_write(struct fsi_device *dev, uint32_t addr, const void *val, 1144efe37f4SJeremy Kerr size_t size) 1154efe37f4SJeremy Kerr { 1164efe37f4SJeremy Kerr if (addr > dev->size || size > dev->size || addr > dev->size - size) 1174efe37f4SJeremy Kerr return -EINVAL; 1184efe37f4SJeremy Kerr 1194efe37f4SJeremy Kerr return fsi_slave_write(dev->slave, dev->addr + addr, val, size); 1204efe37f4SJeremy Kerr } 1214efe37f4SJeremy Kerr EXPORT_SYMBOL_GPL(fsi_device_write); 1224efe37f4SJeremy Kerr 1234efe37f4SJeremy Kerr int fsi_device_peek(struct fsi_device *dev, void *val) 1244efe37f4SJeremy Kerr { 1254efe37f4SJeremy Kerr uint32_t addr = FSI_PEEK_BASE + ((dev->unit - 2) * sizeof(uint32_t)); 1264efe37f4SJeremy Kerr 1274efe37f4SJeremy Kerr return fsi_slave_read(dev->slave, addr, val, sizeof(uint32_t)); 1284efe37f4SJeremy Kerr } 129f7ade2a6SJeremy Kerr 130f7ade2a6SJeremy Kerr static void fsi_device_release(struct device *_device) 131f7ade2a6SJeremy Kerr { 132f7ade2a6SJeremy Kerr struct fsi_device *device = to_fsi_dev(_device); 133f7ade2a6SJeremy Kerr 134f7ade2a6SJeremy Kerr kfree(device); 135f7ade2a6SJeremy Kerr } 136f7ade2a6SJeremy Kerr 137f7ade2a6SJeremy Kerr static struct fsi_device *fsi_create_device(struct fsi_slave *slave) 138f7ade2a6SJeremy Kerr { 139f7ade2a6SJeremy Kerr struct fsi_device *dev; 140f7ade2a6SJeremy Kerr 141f7ade2a6SJeremy Kerr dev = kzalloc(sizeof(*dev), GFP_KERNEL); 142f7ade2a6SJeremy Kerr if (!dev) 143f7ade2a6SJeremy Kerr return NULL; 144f7ade2a6SJeremy Kerr 145f7ade2a6SJeremy Kerr dev->dev.parent = &slave->dev; 146f7ade2a6SJeremy Kerr dev->dev.bus = &fsi_bus_type; 147f7ade2a6SJeremy Kerr dev->dev.release = fsi_device_release; 148f7ade2a6SJeremy Kerr 149f7ade2a6SJeremy Kerr return dev; 150f7ade2a6SJeremy Kerr } 151f7ade2a6SJeremy Kerr 152414c1026SJeremy Kerr /* FSI slave support */ 153014c2abcSJeremy Kerr static int fsi_slave_calc_addr(struct fsi_slave *slave, uint32_t *addrp, 154014c2abcSJeremy Kerr uint8_t *idp) 155014c2abcSJeremy Kerr { 156014c2abcSJeremy Kerr uint32_t addr = *addrp; 157014c2abcSJeremy Kerr uint8_t id = *idp; 158014c2abcSJeremy Kerr 159014c2abcSJeremy Kerr if (addr > slave->size) 160014c2abcSJeremy Kerr return -EINVAL; 161014c2abcSJeremy Kerr 162014c2abcSJeremy Kerr /* For 23 bit addressing, we encode the extra two bits in the slave 163014c2abcSJeremy Kerr * id (and the slave's actual ID needs to be 0). 164014c2abcSJeremy Kerr */ 165014c2abcSJeremy Kerr if (addr > 0x1fffff) { 166014c2abcSJeremy Kerr if (slave->id != 0) 167014c2abcSJeremy Kerr return -EINVAL; 168014c2abcSJeremy Kerr id = (addr >> 21) & 0x3; 169014c2abcSJeremy Kerr addr &= 0x1fffff; 170014c2abcSJeremy Kerr } 171014c2abcSJeremy Kerr 172014c2abcSJeremy Kerr *addrp = addr; 173014c2abcSJeremy Kerr *idp = id; 174014c2abcSJeremy Kerr return 0; 175014c2abcSJeremy Kerr } 176014c2abcSJeremy Kerr 177014c2abcSJeremy Kerr static int fsi_slave_read(struct fsi_slave *slave, uint32_t addr, 178014c2abcSJeremy Kerr void *val, size_t size) 179014c2abcSJeremy Kerr { 180014c2abcSJeremy Kerr uint8_t id = slave->id; 181014c2abcSJeremy Kerr int rc; 182014c2abcSJeremy Kerr 183014c2abcSJeremy Kerr rc = fsi_slave_calc_addr(slave, &addr, &id); 184014c2abcSJeremy Kerr if (rc) 185014c2abcSJeremy Kerr return rc; 186014c2abcSJeremy Kerr 187014c2abcSJeremy Kerr return fsi_master_read(slave->master, slave->link, id, 188014c2abcSJeremy Kerr addr, val, size); 189014c2abcSJeremy Kerr } 190014c2abcSJeremy Kerr 191014c2abcSJeremy Kerr static int fsi_slave_write(struct fsi_slave *slave, uint32_t addr, 192014c2abcSJeremy Kerr const void *val, size_t size) 193014c2abcSJeremy Kerr { 194014c2abcSJeremy Kerr uint8_t id = slave->id; 195014c2abcSJeremy Kerr int rc; 196014c2abcSJeremy Kerr 197014c2abcSJeremy Kerr rc = fsi_slave_calc_addr(slave, &addr, &id); 198014c2abcSJeremy Kerr if (rc) 199014c2abcSJeremy Kerr return rc; 200014c2abcSJeremy Kerr 201014c2abcSJeremy Kerr return fsi_master_write(slave->master, slave->link, id, 202014c2abcSJeremy Kerr addr, val, size); 203014c2abcSJeremy Kerr } 204014c2abcSJeremy Kerr 205f7ade2a6SJeremy Kerr static int fsi_slave_scan(struct fsi_slave *slave) 206f7ade2a6SJeremy Kerr { 207f7ade2a6SJeremy Kerr uint32_t engine_addr; 208f7ade2a6SJeremy Kerr uint32_t conf; 209f7ade2a6SJeremy Kerr int rc, i; 210f7ade2a6SJeremy Kerr 211f7ade2a6SJeremy Kerr /* 212f7ade2a6SJeremy Kerr * scan engines 213f7ade2a6SJeremy Kerr * 214f7ade2a6SJeremy Kerr * We keep the peek mode and slave engines for the core; so start 215f7ade2a6SJeremy Kerr * at the third slot in the configuration table. We also need to 216f7ade2a6SJeremy Kerr * skip the chip ID entry at the start of the address space. 217f7ade2a6SJeremy Kerr */ 218f7ade2a6SJeremy Kerr engine_addr = engine_page_size * 3; 219f7ade2a6SJeremy Kerr for (i = 2; i < engine_page_size / sizeof(uint32_t); i++) { 220f7ade2a6SJeremy Kerr uint8_t slots, version, type, crc; 221f7ade2a6SJeremy Kerr struct fsi_device *dev; 222f7ade2a6SJeremy Kerr 223f7ade2a6SJeremy Kerr rc = fsi_slave_read(slave, (i + 1) * sizeof(conf), 224f7ade2a6SJeremy Kerr &conf, sizeof(conf)); 225f7ade2a6SJeremy Kerr if (rc) { 226f7ade2a6SJeremy Kerr dev_warn(&slave->dev, 227f7ade2a6SJeremy Kerr "error reading slave registers\n"); 228f7ade2a6SJeremy Kerr return -1; 229f7ade2a6SJeremy Kerr } 230f7ade2a6SJeremy Kerr conf = be32_to_cpu(conf); 231f7ade2a6SJeremy Kerr 232f7ade2a6SJeremy Kerr crc = crc4(0, conf, 32); 233f7ade2a6SJeremy Kerr if (crc) { 234f7ade2a6SJeremy Kerr dev_warn(&slave->dev, 235f7ade2a6SJeremy Kerr "crc error in slave register at 0x%04x\n", 236f7ade2a6SJeremy Kerr i); 237f7ade2a6SJeremy Kerr return -1; 238f7ade2a6SJeremy Kerr } 239f7ade2a6SJeremy Kerr 240f7ade2a6SJeremy Kerr slots = (conf & FSI_SLAVE_CONF_SLOTS_MASK) 241f7ade2a6SJeremy Kerr >> FSI_SLAVE_CONF_SLOTS_SHIFT; 242f7ade2a6SJeremy Kerr version = (conf & FSI_SLAVE_CONF_VERSION_MASK) 243f7ade2a6SJeremy Kerr >> FSI_SLAVE_CONF_VERSION_SHIFT; 244f7ade2a6SJeremy Kerr type = (conf & FSI_SLAVE_CONF_TYPE_MASK) 245f7ade2a6SJeremy Kerr >> FSI_SLAVE_CONF_TYPE_SHIFT; 246f7ade2a6SJeremy Kerr 247f7ade2a6SJeremy Kerr /* 248f7ade2a6SJeremy Kerr * Unused address areas are marked by a zero type value; this 249f7ade2a6SJeremy Kerr * skips the defined address areas 250f7ade2a6SJeremy Kerr */ 251f7ade2a6SJeremy Kerr if (type != 0 && slots != 0) { 252f7ade2a6SJeremy Kerr 253f7ade2a6SJeremy Kerr /* create device */ 254f7ade2a6SJeremy Kerr dev = fsi_create_device(slave); 255f7ade2a6SJeremy Kerr if (!dev) 256f7ade2a6SJeremy Kerr return -ENOMEM; 257f7ade2a6SJeremy Kerr 258f7ade2a6SJeremy Kerr dev->slave = slave; 259f7ade2a6SJeremy Kerr dev->engine_type = type; 260f7ade2a6SJeremy Kerr dev->version = version; 261f7ade2a6SJeremy Kerr dev->unit = i; 262f7ade2a6SJeremy Kerr dev->addr = engine_addr; 263f7ade2a6SJeremy Kerr dev->size = slots * engine_page_size; 264f7ade2a6SJeremy Kerr 265f7ade2a6SJeremy Kerr dev_dbg(&slave->dev, 266f7ade2a6SJeremy Kerr "engine[%i]: type %x, version %x, addr %x size %x\n", 267f7ade2a6SJeremy Kerr dev->unit, dev->engine_type, version, 268f7ade2a6SJeremy Kerr dev->addr, dev->size); 269f7ade2a6SJeremy Kerr 270f7ade2a6SJeremy Kerr dev_set_name(&dev->dev, "%02x:%02x:%02x:%02x", 271f7ade2a6SJeremy Kerr slave->master->idx, slave->link, 272f7ade2a6SJeremy Kerr slave->id, i - 2); 273f7ade2a6SJeremy Kerr 274f7ade2a6SJeremy Kerr rc = device_register(&dev->dev); 275f7ade2a6SJeremy Kerr if (rc) { 276f7ade2a6SJeremy Kerr dev_warn(&slave->dev, "add failed: %d\n", rc); 277f7ade2a6SJeremy Kerr put_device(&dev->dev); 278f7ade2a6SJeremy Kerr } 279f7ade2a6SJeremy Kerr } 280f7ade2a6SJeremy Kerr 281f7ade2a6SJeremy Kerr engine_addr += slots * engine_page_size; 282f7ade2a6SJeremy Kerr 283f7ade2a6SJeremy Kerr if (!(conf & FSI_SLAVE_CONF_NEXT_MASK)) 284f7ade2a6SJeremy Kerr break; 285f7ade2a6SJeremy Kerr } 286f7ade2a6SJeremy Kerr 287f7ade2a6SJeremy Kerr return 0; 288f7ade2a6SJeremy Kerr } 289f7ade2a6SJeremy Kerr 2902b37c3e2SChristopher Bostic /* Encode slave local bus echo delay */ 2912b37c3e2SChristopher Bostic static inline uint32_t fsi_smode_echodly(int x) 2922b37c3e2SChristopher Bostic { 2932b37c3e2SChristopher Bostic return (x & FSI_SMODE_ED_MASK) << FSI_SMODE_ED_SHIFT; 2942b37c3e2SChristopher Bostic } 2952b37c3e2SChristopher Bostic 2962b37c3e2SChristopher Bostic /* Encode slave local bus send delay */ 2972b37c3e2SChristopher Bostic static inline uint32_t fsi_smode_senddly(int x) 2982b37c3e2SChristopher Bostic { 2992b37c3e2SChristopher Bostic return (x & FSI_SMODE_SD_MASK) << FSI_SMODE_SD_SHIFT; 3002b37c3e2SChristopher Bostic } 3012b37c3e2SChristopher Bostic 3022b37c3e2SChristopher Bostic /* Encode slave local bus clock rate ratio */ 3032b37c3e2SChristopher Bostic static inline uint32_t fsi_smode_lbcrr(int x) 3042b37c3e2SChristopher Bostic { 3052b37c3e2SChristopher Bostic return (x & FSI_SMODE_LBCRR_MASK) << FSI_SMODE_LBCRR_SHIFT; 3062b37c3e2SChristopher Bostic } 3072b37c3e2SChristopher Bostic 3082b37c3e2SChristopher Bostic /* Encode slave ID */ 3092b37c3e2SChristopher Bostic static inline uint32_t fsi_smode_sid(int x) 3102b37c3e2SChristopher Bostic { 3112b37c3e2SChristopher Bostic return (x & FSI_SMODE_SID_MASK) << FSI_SMODE_SID_SHIFT; 3122b37c3e2SChristopher Bostic } 3132b37c3e2SChristopher Bostic 3142b37c3e2SChristopher Bostic static const uint32_t fsi_slave_smode(int id) 3152b37c3e2SChristopher Bostic { 3162b37c3e2SChristopher Bostic return FSI_SMODE_WSC | FSI_SMODE_ECRC 3172b37c3e2SChristopher Bostic | fsi_smode_sid(id) 3182b37c3e2SChristopher Bostic | fsi_smode_echodly(0xf) | fsi_smode_senddly(0xf) 3192b37c3e2SChristopher Bostic | fsi_smode_lbcrr(0x8); 3202b37c3e2SChristopher Bostic } 3212b37c3e2SChristopher Bostic 3222b37c3e2SChristopher Bostic static int fsi_slave_set_smode(struct fsi_master *master, int link, int id) 3232b37c3e2SChristopher Bostic { 3242b37c3e2SChristopher Bostic uint32_t smode; 3252b37c3e2SChristopher Bostic 3262b37c3e2SChristopher Bostic /* set our smode register with the slave ID field to 0; this enables 3272b37c3e2SChristopher Bostic * extended slave addressing 3282b37c3e2SChristopher Bostic */ 3292b37c3e2SChristopher Bostic smode = fsi_slave_smode(id); 3302b37c3e2SChristopher Bostic smode = cpu_to_be32(smode); 3312b37c3e2SChristopher Bostic 3322b37c3e2SChristopher Bostic return fsi_master_write(master, link, id, FSI_SLAVE_BASE + FSI_SMODE, 3332b37c3e2SChristopher Bostic &smode, sizeof(smode)); 3342b37c3e2SChristopher Bostic } 3352b37c3e2SChristopher Bostic 3362b545cd8SJeremy Kerr static void fsi_slave_release(struct device *dev) 3372b545cd8SJeremy Kerr { 3382b545cd8SJeremy Kerr struct fsi_slave *slave = to_fsi_slave(dev); 3392b545cd8SJeremy Kerr 3402b545cd8SJeremy Kerr kfree(slave); 3412b545cd8SJeremy Kerr } 3422b545cd8SJeremy Kerr 343414c1026SJeremy Kerr static int fsi_slave_init(struct fsi_master *master, int link, uint8_t id) 344414c1026SJeremy Kerr { 3452b545cd8SJeremy Kerr struct fsi_slave *slave; 3462b545cd8SJeremy Kerr uint32_t chip_id; 3472b545cd8SJeremy Kerr uint8_t crc; 3482b545cd8SJeremy Kerr int rc; 349414c1026SJeremy Kerr 3502b545cd8SJeremy Kerr /* Currently, we only support single slaves on a link, and use the 3512b545cd8SJeremy Kerr * full 23-bit address range 3522b545cd8SJeremy Kerr */ 3532b545cd8SJeremy Kerr if (id != 0) 3542b545cd8SJeremy Kerr return -EINVAL; 3552b545cd8SJeremy Kerr 3562b545cd8SJeremy Kerr rc = fsi_master_read(master, link, id, 0, &chip_id, sizeof(chip_id)); 3572b545cd8SJeremy Kerr if (rc) { 3582b545cd8SJeremy Kerr dev_dbg(&master->dev, "can't read slave %02x:%02x %d\n", 3592b545cd8SJeremy Kerr link, id, rc); 360414c1026SJeremy Kerr return -ENODEV; 361414c1026SJeremy Kerr } 3622b545cd8SJeremy Kerr chip_id = be32_to_cpu(chip_id); 3632b545cd8SJeremy Kerr 3642b545cd8SJeremy Kerr crc = crc4(0, chip_id, 32); 3652b545cd8SJeremy Kerr if (crc) { 3662b545cd8SJeremy Kerr dev_warn(&master->dev, "slave %02x:%02x invalid chip id CRC!\n", 3672b545cd8SJeremy Kerr link, id); 3682b545cd8SJeremy Kerr return -EIO; 3692b545cd8SJeremy Kerr } 3702b545cd8SJeremy Kerr 3712b545cd8SJeremy Kerr dev_info(&master->dev, "fsi: found chip %08x at %02x:%02x:%02x\n", 3722b545cd8SJeremy Kerr chip_id, master->idx, link, id); 3732b545cd8SJeremy Kerr 3742b37c3e2SChristopher Bostic rc = fsi_slave_set_smode(master, link, id); 3752b37c3e2SChristopher Bostic if (rc) { 3762b37c3e2SChristopher Bostic dev_warn(&master->dev, 3772b37c3e2SChristopher Bostic "can't set smode on slave:%02x:%02x %d\n", 3782b37c3e2SChristopher Bostic link, id, rc); 3792b37c3e2SChristopher Bostic return -ENODEV; 3802b37c3e2SChristopher Bostic } 3812b37c3e2SChristopher Bostic 3822b545cd8SJeremy Kerr /* We can communicate with a slave; create the slave device and 3832b545cd8SJeremy Kerr * register. 3842b545cd8SJeremy Kerr */ 3852b545cd8SJeremy Kerr slave = kzalloc(sizeof(*slave), GFP_KERNEL); 3862b545cd8SJeremy Kerr if (!slave) 3872b545cd8SJeremy Kerr return -ENOMEM; 3882b545cd8SJeremy Kerr 3892b545cd8SJeremy Kerr slave->master = master; 3902b545cd8SJeremy Kerr slave->dev.parent = &master->dev; 3912b545cd8SJeremy Kerr slave->dev.release = fsi_slave_release; 3922b545cd8SJeremy Kerr slave->link = link; 3932b545cd8SJeremy Kerr slave->id = id; 3942b545cd8SJeremy Kerr slave->size = FSI_SLAVE_SIZE_23b; 3952b545cd8SJeremy Kerr 3962b545cd8SJeremy Kerr dev_set_name(&slave->dev, "slave@%02x:%02x", link, id); 3972b545cd8SJeremy Kerr rc = device_register(&slave->dev); 3982b545cd8SJeremy Kerr if (rc < 0) { 3992b545cd8SJeremy Kerr dev_warn(&master->dev, "failed to create slave device: %d\n", 4002b545cd8SJeremy Kerr rc); 4012b545cd8SJeremy Kerr put_device(&slave->dev); 4022b545cd8SJeremy Kerr return rc; 4032b545cd8SJeremy Kerr } 4042b545cd8SJeremy Kerr 405f7ade2a6SJeremy Kerr rc = fsi_slave_scan(slave); 406f7ade2a6SJeremy Kerr if (rc) 407f7ade2a6SJeremy Kerr dev_dbg(&master->dev, "failed during slave scan with: %d\n", 408f7ade2a6SJeremy Kerr rc); 4092b545cd8SJeremy Kerr 4102b545cd8SJeremy Kerr return rc; 4112b545cd8SJeremy Kerr } 412414c1026SJeremy Kerr 41309aecfabSJeremy Kerr /* FSI master support */ 414014c2abcSJeremy Kerr static int fsi_check_access(uint32_t addr, size_t size) 415014c2abcSJeremy Kerr { 416014c2abcSJeremy Kerr if (size != 1 && size != 2 && size != 4) 417014c2abcSJeremy Kerr return -EINVAL; 418014c2abcSJeremy Kerr 419014c2abcSJeremy Kerr if ((addr & 0x3) != (size & 0x3)) 420014c2abcSJeremy Kerr return -EINVAL; 421014c2abcSJeremy Kerr 422014c2abcSJeremy Kerr return 0; 423014c2abcSJeremy Kerr } 424014c2abcSJeremy Kerr 425014c2abcSJeremy Kerr static int fsi_master_read(struct fsi_master *master, int link, 426014c2abcSJeremy Kerr uint8_t slave_id, uint32_t addr, void *val, size_t size) 427014c2abcSJeremy Kerr { 428014c2abcSJeremy Kerr int rc; 429014c2abcSJeremy Kerr 430014c2abcSJeremy Kerr rc = fsi_check_access(addr, size); 431014c2abcSJeremy Kerr if (rc) 432014c2abcSJeremy Kerr return rc; 433014c2abcSJeremy Kerr 434014c2abcSJeremy Kerr return master->read(master, link, slave_id, addr, val, size); 435014c2abcSJeremy Kerr } 436014c2abcSJeremy Kerr 437014c2abcSJeremy Kerr static int fsi_master_write(struct fsi_master *master, int link, 438014c2abcSJeremy Kerr uint8_t slave_id, uint32_t addr, const void *val, size_t size) 439014c2abcSJeremy Kerr { 440014c2abcSJeremy Kerr int rc; 441014c2abcSJeremy Kerr 442014c2abcSJeremy Kerr rc = fsi_check_access(addr, size); 443014c2abcSJeremy Kerr if (rc) 444014c2abcSJeremy Kerr return rc; 445014c2abcSJeremy Kerr 446014c2abcSJeremy Kerr return master->write(master, link, slave_id, addr, val, size); 447014c2abcSJeremy Kerr } 448014c2abcSJeremy Kerr 44926095282SChristopher Bostic static int fsi_master_link_enable(struct fsi_master *master, int link) 45026095282SChristopher Bostic { 45126095282SChristopher Bostic if (master->link_enable) 45226095282SChristopher Bostic return master->link_enable(master, link); 45326095282SChristopher Bostic 45426095282SChristopher Bostic return 0; 45526095282SChristopher Bostic } 45626095282SChristopher Bostic 45726095282SChristopher Bostic /* 45826095282SChristopher Bostic * Issue a break command on this link 45926095282SChristopher Bostic */ 46026095282SChristopher Bostic static int fsi_master_break(struct fsi_master *master, int link) 46126095282SChristopher Bostic { 46226095282SChristopher Bostic if (master->send_break) 46326095282SChristopher Bostic return master->send_break(master, link); 46426095282SChristopher Bostic 46526095282SChristopher Bostic return 0; 46626095282SChristopher Bostic } 46726095282SChristopher Bostic 468414c1026SJeremy Kerr static int fsi_master_scan(struct fsi_master *master) 469414c1026SJeremy Kerr { 47026095282SChristopher Bostic int link, rc; 471414c1026SJeremy Kerr 47226095282SChristopher Bostic for (link = 0; link < master->n_links; link++) { 47326095282SChristopher Bostic rc = fsi_master_link_enable(master, link); 47426095282SChristopher Bostic if (rc) { 47526095282SChristopher Bostic dev_dbg(&master->dev, 47626095282SChristopher Bostic "enable link %d failed: %d\n", link, rc); 47726095282SChristopher Bostic continue; 47826095282SChristopher Bostic } 47926095282SChristopher Bostic rc = fsi_master_break(master, link); 48026095282SChristopher Bostic if (rc) { 48126095282SChristopher Bostic dev_dbg(&master->dev, 48226095282SChristopher Bostic "break to link %d failed: %d\n", link, rc); 48326095282SChristopher Bostic continue; 48426095282SChristopher Bostic } 48526095282SChristopher Bostic 486414c1026SJeremy Kerr fsi_slave_init(master, link, 0); 48726095282SChristopher Bostic } 488414c1026SJeremy Kerr 489414c1026SJeremy Kerr return 0; 490414c1026SJeremy Kerr } 491414c1026SJeremy Kerr 492cd0fdb5cSChristopher Bostic static int fsi_slave_remove_device(struct device *dev, void *arg) 493cd0fdb5cSChristopher Bostic { 494cd0fdb5cSChristopher Bostic device_unregister(dev); 495cd0fdb5cSChristopher Bostic return 0; 496cd0fdb5cSChristopher Bostic } 497cd0fdb5cSChristopher Bostic 498cd0fdb5cSChristopher Bostic static int fsi_master_remove_slave(struct device *dev, void *arg) 499cd0fdb5cSChristopher Bostic { 500cd0fdb5cSChristopher Bostic device_for_each_child(dev, NULL, fsi_slave_remove_device); 501cd0fdb5cSChristopher Bostic device_unregister(dev); 502cd0fdb5cSChristopher Bostic return 0; 503cd0fdb5cSChristopher Bostic } 504cd0fdb5cSChristopher Bostic 505cd0fdb5cSChristopher Bostic static void fsi_master_unscan(struct fsi_master *master) 506cd0fdb5cSChristopher Bostic { 507cd0fdb5cSChristopher Bostic device_for_each_child(&master->dev, NULL, fsi_master_remove_slave); 508cd0fdb5cSChristopher Bostic } 509cd0fdb5cSChristopher Bostic 510cd0fdb5cSChristopher Bostic static ssize_t master_rescan_store(struct device *dev, 511cd0fdb5cSChristopher Bostic struct device_attribute *attr, const char *buf, size_t count) 512cd0fdb5cSChristopher Bostic { 513cd0fdb5cSChristopher Bostic struct fsi_master *master = to_fsi_master(dev); 514cd0fdb5cSChristopher Bostic int rc; 515cd0fdb5cSChristopher Bostic 516cd0fdb5cSChristopher Bostic fsi_master_unscan(master); 517cd0fdb5cSChristopher Bostic rc = fsi_master_scan(master); 518cd0fdb5cSChristopher Bostic if (rc < 0) 519cd0fdb5cSChristopher Bostic return rc; 520cd0fdb5cSChristopher Bostic 521cd0fdb5cSChristopher Bostic return count; 522cd0fdb5cSChristopher Bostic } 523cd0fdb5cSChristopher Bostic 524cd0fdb5cSChristopher Bostic static DEVICE_ATTR(rescan, 0200, NULL, master_rescan_store); 525cd0fdb5cSChristopher Bostic 52609aecfabSJeremy Kerr int fsi_master_register(struct fsi_master *master) 52709aecfabSJeremy Kerr { 52809aecfabSJeremy Kerr int rc; 52909aecfabSJeremy Kerr 53009aecfabSJeremy Kerr if (!master) 53109aecfabSJeremy Kerr return -EINVAL; 53209aecfabSJeremy Kerr 53309aecfabSJeremy Kerr master->idx = ida_simple_get(&master_ida, 0, INT_MAX, GFP_KERNEL); 53409aecfabSJeremy Kerr dev_set_name(&master->dev, "fsi%d", master->idx); 53509aecfabSJeremy Kerr 53609aecfabSJeremy Kerr rc = device_register(&master->dev); 537414c1026SJeremy Kerr if (rc) { 53809aecfabSJeremy Kerr ida_simple_remove(&master_ida, master->idx); 53909aecfabSJeremy Kerr return rc; 54009aecfabSJeremy Kerr } 541414c1026SJeremy Kerr 542cd0fdb5cSChristopher Bostic rc = device_create_file(&master->dev, &dev_attr_rescan); 543cd0fdb5cSChristopher Bostic if (rc) { 544cd0fdb5cSChristopher Bostic device_unregister(&master->dev); 545cd0fdb5cSChristopher Bostic ida_simple_remove(&master_ida, master->idx); 546cd0fdb5cSChristopher Bostic return rc; 547cd0fdb5cSChristopher Bostic } 548cd0fdb5cSChristopher Bostic 549414c1026SJeremy Kerr fsi_master_scan(master); 550cd0fdb5cSChristopher Bostic 551414c1026SJeremy Kerr return 0; 552414c1026SJeremy Kerr } 55309aecfabSJeremy Kerr EXPORT_SYMBOL_GPL(fsi_master_register); 55409aecfabSJeremy Kerr 55509aecfabSJeremy Kerr void fsi_master_unregister(struct fsi_master *master) 55609aecfabSJeremy Kerr { 55709aecfabSJeremy Kerr if (master->idx >= 0) { 55809aecfabSJeremy Kerr ida_simple_remove(&master_ida, master->idx); 55909aecfabSJeremy Kerr master->idx = -1; 56009aecfabSJeremy Kerr } 56109aecfabSJeremy Kerr 562cd0fdb5cSChristopher Bostic fsi_master_unscan(master); 56309aecfabSJeremy Kerr device_unregister(&master->dev); 56409aecfabSJeremy Kerr } 56509aecfabSJeremy Kerr EXPORT_SYMBOL_GPL(fsi_master_unregister); 56609aecfabSJeremy Kerr 5670508ad1fSJeremy Kerr /* FSI core & Linux bus type definitions */ 5680508ad1fSJeremy Kerr 569dd37eed7SJeremy Kerr static int fsi_bus_match(struct device *dev, struct device_driver *drv) 570dd37eed7SJeremy Kerr { 571dd37eed7SJeremy Kerr struct fsi_device *fsi_dev = to_fsi_dev(dev); 572dd37eed7SJeremy Kerr struct fsi_driver *fsi_drv = to_fsi_drv(drv); 573dd37eed7SJeremy Kerr const struct fsi_device_id *id; 574dd37eed7SJeremy Kerr 575dd37eed7SJeremy Kerr if (!fsi_drv->id_table) 576dd37eed7SJeremy Kerr return 0; 577dd37eed7SJeremy Kerr 578dd37eed7SJeremy Kerr for (id = fsi_drv->id_table; id->engine_type; id++) { 579dd37eed7SJeremy Kerr if (id->engine_type != fsi_dev->engine_type) 580dd37eed7SJeremy Kerr continue; 581dd37eed7SJeremy Kerr if (id->version == FSI_VERSION_ANY || 582dd37eed7SJeremy Kerr id->version == fsi_dev->version) 583dd37eed7SJeremy Kerr return 1; 584dd37eed7SJeremy Kerr } 585dd37eed7SJeremy Kerr 586dd37eed7SJeremy Kerr return 0; 587dd37eed7SJeremy Kerr } 588dd37eed7SJeremy Kerr 5890508ad1fSJeremy Kerr struct bus_type fsi_bus_type = { 5900508ad1fSJeremy Kerr .name = "fsi", 591dd37eed7SJeremy Kerr .match = fsi_bus_match, 5920508ad1fSJeremy Kerr }; 5930508ad1fSJeremy Kerr EXPORT_SYMBOL_GPL(fsi_bus_type); 5940508ad1fSJeremy Kerr 5950508ad1fSJeremy Kerr static int fsi_init(void) 5960508ad1fSJeremy Kerr { 5970508ad1fSJeremy Kerr return bus_register(&fsi_bus_type); 5980508ad1fSJeremy Kerr } 5990508ad1fSJeremy Kerr 6000508ad1fSJeremy Kerr static void fsi_exit(void) 6010508ad1fSJeremy Kerr { 6020508ad1fSJeremy Kerr bus_unregister(&fsi_bus_type); 6030508ad1fSJeremy Kerr } 6040508ad1fSJeremy Kerr 6050508ad1fSJeremy Kerr module_init(fsi_init); 6060508ad1fSJeremy Kerr module_exit(fsi_exit); 607