drivers/misc/eeprom/idt_89hpesx.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  *   Copyright (C) 2016 T-Platforms. All Rights Reserved.
   4  *
   5  * IDT PCIe-switch NTB Linux driver
   6  *
   7  * Contact Information:
   8  * Serge Semin <fancer.lancer@gmail.com>, <Sergey.Semin@t-platforms.ru>
   9  */
  10 /*
  11  *           NOTE of the IDT 89HPESx SMBus-slave interface driver
  12  *    This driver primarily is developed to have an access to EEPROM device of
  13  * IDT PCIe-switches. IDT provides a simple SMBus interface to perform IO-
  14  * operations from/to EEPROM, which is located at private (so called Master)
  15  * SMBus of switches. Using that interface this the driver creates a simple
  16  * binary sysfs-file in the device directory:
  17  * /sys/bus/i2c/devices/<bus>-<devaddr>/eeprom
  18  * In case if read-only flag is specified in the dts-node of device desription,
  19  * User-space applications won't be able to write to the EEPROM sysfs-node.
  20  *    Additionally IDT 89HPESx SMBus interface has an ability to write/read
  21  * data of device CSRs. This driver exposes debugf-file to perform simple IO
  22  * operations using that ability for just basic debug purpose. Particularly
  23  * next file is created in the specific debugfs-directory:
  24  * /sys/kernel/debug/idt_csr/
  25  * Format of the debugfs-node is:
  26  * $ cat /sys/kernel/debug/idt_csr/<bus>-<devaddr>/<devname>;
  27  * <CSR address>:<CSR value>
  28  * So reading the content of the file gives current CSR address and it value.
  29  * If User-space application wishes to change current CSR address,
  30  * it can just write a proper value to the sysfs-file:
  31  * $ echo "<CSR address>" > /sys/kernel/debug/idt_csr/<bus>-<devaddr>/<devname>
  32  * If it wants to change the CSR value as well, the format of the write
  33  * operation is:
  34  * $ echo "<CSR address>:<CSR value>" > \
  35  *        /sys/kernel/debug/idt_csr/<bus>-<devaddr>/<devname>;
  36  * CSR address and value can be any of hexadecimal, decimal or octal format.
  37  */
  38
  39 #include <linux/kernel.h>
  40 #include <linux/init.h>
  41 #include <linux/module.h>
  42 #include <linux/types.h>
  43 #include <linux/sizes.h>
  44 #include <linux/slab.h>
  45 #include <linux/mutex.h>
  46 #include <linux/sysfs.h>
  47 #include <linux/debugfs.h>
  48 #include <linux/mod_devicetable.h>
  49 #include <linux/property.h>
  50 #include <linux/i2c.h>
  51 #include <linux/pci_ids.h>
  52 #include <linux/delay.h>
  53
  54 #define IDT_NAME                "89hpesx"
  55 #define IDT_89HPESX_DESC        "IDT 89HPESx SMBus-slave interface driver"
  56 #define IDT_89HPESX_VER         "1.0"
  57
  58 MODULE_DESCRIPTION(IDT_89HPESX_DESC);
  59 MODULE_VERSION(IDT_89HPESX_VER);
  60 MODULE_LICENSE("GPL v2");
  61 MODULE_AUTHOR("T-platforms");
  62
  63 /*
  64  * csr_dbgdir - CSR read/write operations Debugfs directory
  65  */
  66 static struct dentry *csr_dbgdir;
  67
  68 /*
  69  * struct idt_89hpesx_dev - IDT 89HPESx device data structure
  70  * @eesize:     Size of EEPROM in bytes (calculated from "idt,eecompatible")
  71  * @eero:       EEPROM Read-only flag
  72  * @eeaddr:     EEPROM custom address
  73  *
  74  * @inieecmd:   Initial cmd value for EEPROM read/write operations
  75  * @inicsrcmd:  Initial cmd value for CSR read/write operations
  76  * @iniccode:   Initialial command code value for IO-operations
  77  *
  78  * @csr:        CSR address to perform read operation
  79  *
  80  * @smb_write:  SMBus write method
  81  * @smb_read:   SMBus read method
  82  * @smb_mtx:    SMBus mutex
  83  *
  84  * @client:     i2c client used to perform IO operations
  85  *
  86  * @ee_file:    EEPROM read/write sysfs-file
  87  */
  88 struct idt_smb_seq;
  89 struct idt_89hpesx_dev {
  90         u32 eesize;
  91         bool eero;
  92         u8 eeaddr;
  93
  94         u8 inieecmd;
  95         u8 inicsrcmd;
  96         u8 iniccode;
  97
  98         u16 csr;
  99
 100         int (*smb_write)(struct idt_89hpesx_dev *, const struct idt_smb_seq *);
 101         int (*smb_read)(struct idt_89hpesx_dev *, struct idt_smb_seq *);
 102         struct mutex smb_mtx;
 103
 104         struct i2c_client *client;
 105
 106         struct bin_attribute *ee_file;
 107         struct dentry *csr_dir;
 108 };
 109
 110 /*
 111  * struct idt_smb_seq - sequence of data to be read/written from/to IDT 89HPESx
 112  * @ccode:      SMBus command code
 113  * @bytecnt:    Byte count of operation
 114  * @data:       Data to by written
 115  */
 116 struct idt_smb_seq {
 117         u8 ccode;
 118         u8 bytecnt;
 119         u8 *data;
 120 };
 121
 122 /*
 123  * struct idt_eeprom_seq - sequence of data to be read/written from/to EEPROM
 124  * @cmd:        Transaction CMD
 125  * @eeaddr:     EEPROM custom address
 126  * @memaddr:    Internal memory address of EEPROM
 127  * @data:       Data to be written at the memory address
 128  */
 129 struct idt_eeprom_seq {
 130         u8 cmd;
 131         u8 eeaddr;
 132         u16 memaddr;
 133         u8 data;
 134 } __packed;
 135
 136 /*
 137  * struct idt_csr_seq - sequence of data to be read/written from/to CSR
 138  * @cmd:        Transaction CMD
 139  * @csraddr:    Internal IDT device CSR address
 140  * @data:       Data to be read/written from/to the CSR address
 141  */
 142 struct idt_csr_seq {
 143         u8 cmd;
 144         u16 csraddr;
 145         u32 data;
 146 } __packed;
 147
 148 /*
 149  * SMBus command code macros
 150  * @CCODE_END:          Indicates the end of transaction
 151  * @CCODE_START:        Indicates the start of transaction
 152  * @CCODE_CSR:          CSR read/write transaction
 153  * @CCODE_EEPROM:       EEPROM read/write transaction
 154  * @CCODE_BYTE:         Supplied data has BYTE length
 155  * @CCODE_WORD:         Supplied data has WORD length
 156  * @CCODE_BLOCK:        Supplied data has variable length passed in bytecnt
 157  *                      byte right following CCODE byte
 158  */
 159 #define CCODE_END       ((u8)0x01)
 160 #define CCODE_START     ((u8)0x02)
 161 #define CCODE_CSR       ((u8)0x00)
 162 #define CCODE_EEPROM    ((u8)0x04)
 163 #define CCODE_BYTE      ((u8)0x00)
 164 #define CCODE_WORD      ((u8)0x20)
 165 #define CCODE_BLOCK     ((u8)0x40)
 166 #define CCODE_PEC       ((u8)0x80)
 167
 168 /*
 169  * EEPROM command macros
 170  * @EEPROM_OP_WRITE:    EEPROM write operation
 171  * @EEPROM_OP_READ:     EEPROM read operation
 172  * @EEPROM_USA:         Use specified address of EEPROM
 173  * @EEPROM_NAERR:       EEPROM device is not ready to respond
 174  * @EEPROM_LAERR:       EEPROM arbitration loss error
 175  * @EEPROM_MSS:         EEPROM misplace start & stop bits error
 176  * @EEPROM_WR_CNT:      Bytes count to perform write operation
 177  * @EEPROM_WRRD_CNT:    Bytes count to write before reading
 178  * @EEPROM_RD_CNT:      Bytes count to perform read operation
 179  * @EEPROM_DEF_SIZE:    Fall back size of EEPROM
 180  * @EEPROM_DEF_ADDR:    Defatul EEPROM address
 181  * @EEPROM_TOUT:        Timeout before retry read operation if eeprom is busy
 182  */
 183 #define EEPROM_OP_WRITE ((u8)0x00)
 184 #define EEPROM_OP_READ  ((u8)0x01)
 185 #define EEPROM_USA      ((u8)0x02)
 186 #define EEPROM_NAERR    ((u8)0x08)
 187 #define EEPROM_LAERR    ((u8)0x10)
 188 #define EEPROM_MSS      ((u8)0x20)
 189 #define EEPROM_WR_CNT   ((u8)5)
 190 #define EEPROM_WRRD_CNT ((u8)4)
 191 #define EEPROM_RD_CNT   ((u8)5)
 192 #define EEPROM_DEF_SIZE ((u16)4096)
 193 #define EEPROM_DEF_ADDR ((u8)0x50)
 194 #define EEPROM_TOUT     (100)
 195
 196 /*
 197  * CSR command macros
 198  * @CSR_DWE:            Enable all four bytes of the operation
 199  * @CSR_OP_WRITE:       CSR write operation
 200  * @CSR_OP_READ:        CSR read operation
 201  * @CSR_RERR:           Read operation error
 202  * @CSR_WERR:           Write operation error
 203  * @CSR_WR_CNT:         Bytes count to perform write operation
 204  * @CSR_WRRD_CNT:       Bytes count to write before reading
 205  * @CSR_RD_CNT:         Bytes count to perform read operation
 206  * @CSR_MAX:            Maximum CSR address
 207  * @CSR_DEF:            Default CSR address
 208  * @CSR_REAL_ADDR:      CSR real unshifted address
 209  */
 210 #define CSR_DWE                 ((u8)0x0F)
 211 #define CSR_OP_WRITE            ((u8)0x00)
 212 #define CSR_OP_READ             ((u8)0x10)
 213 #define CSR_RERR                ((u8)0x40)
 214 #define CSR_WERR                ((u8)0x80)
 215 #define CSR_WR_CNT              ((u8)7)
 216 #define CSR_WRRD_CNT            ((u8)3)
 217 #define CSR_RD_CNT              ((u8)7)
 218 #define CSR_MAX                 ((u32)0x3FFFF)
 219 #define CSR_DEF                 ((u16)0x0000)
 220 #define CSR_REAL_ADDR(val)      ((unsigned int)val << 2)
 221
 222 /*
 223  * IDT 89HPESx basic register
 224  * @IDT_VIDDID_CSR:     PCIe VID and DID of IDT 89HPESx
 225  * @IDT_VID_MASK:       Mask of VID
 226  */
 227 #define IDT_VIDDID_CSR  ((u32)0x0000)
 228 #define IDT_VID_MASK    ((u32)0xFFFF)
 229
 230 /*
 231  * IDT 89HPESx can send NACK when new command is sent before previous one
 232  * fininshed execution. In this case driver retries operation
 233  * certain times.
 234  * @RETRY_CNT:          Number of retries before giving up and fail
 235  * @idt_smb_safe:       Generate a retry loop on corresponding SMBus method
 236  */
 237 #define RETRY_CNT (128)
 238 #define idt_smb_safe(ops, args...) ({ \
 239         int __retry = RETRY_CNT; \
 240         s32 __sts; \
 241         do { \
 242                 __sts = i2c_smbus_ ## ops ## _data(args); \
 243         } while (__retry-- && __sts < 0); \
 244         __sts; \
 245 })
 246
 247 /*===========================================================================
 248  *                         i2c bus level IO-operations
 249  *===========================================================================
 250  */
 251
 252 /*
 253  * idt_smb_write_byte() - SMBus write method when I2C_SMBUS_BYTE_DATA operation
 254  *                        is only available
 255  * @pdev:       Pointer to the driver data
 256  * @seq:        Sequence of data to be written
 257  */
 258 static int idt_smb_write_byte(struct idt_89hpesx_dev *pdev,
 259                               const struct idt_smb_seq *seq)
 260 {
 261         s32 sts;
 262         u8 ccode;
 263         int idx;
 264
 265         /* Loop over the supplied data sending byte one-by-one */
 266         for (idx = 0; idx < seq->bytecnt; idx++) {
 267                 /* Collect the command code byte */
 268                 ccode = seq->ccode | CCODE_BYTE;
 269                 if (idx == 0)
 270                         ccode |= CCODE_START;
 271                 if (idx == seq->bytecnt - 1)
 272                         ccode |= CCODE_END;
 273
 274                 /* Send data to the device */
 275                 sts = idt_smb_safe(write_byte, pdev->client, ccode,
 276                         seq->data[idx]);
 277                 if (sts != 0)
 278                         return (int)sts;
 279         }
 280
 281         return 0;
 282 }
 283
 284 /*
 285  * idt_smb_read_byte() - SMBus read method when I2C_SMBUS_BYTE_DATA operation
 286  *                        is only available
 287  * @pdev:       Pointer to the driver data
 288  * @seq:        Buffer to read data to
 289  */
 290 static int idt_smb_read_byte(struct idt_89hpesx_dev *pdev,
 291                              struct idt_smb_seq *seq)
 292 {
 293         s32 sts;
 294         u8 ccode;
 295         int idx;
 296
 297         /* Loop over the supplied buffer receiving byte one-by-one */
 298         for (idx = 0; idx < seq->bytecnt; idx++) {
 299                 /* Collect the command code byte */
 300                 ccode = seq->ccode | CCODE_BYTE;
 301                 if (idx == 0)
 302                         ccode |= CCODE_START;
 303                 if (idx == seq->bytecnt - 1)
 304                         ccode |= CCODE_END;
 305
 306                 /* Read data from the device */
 307                 sts = idt_smb_safe(read_byte, pdev->client, ccode);
 308                 if (sts < 0)
 309                         return (int)sts;
 310
 311                 seq->data[idx] = (u8)sts;
 312         }
 313
 314         return 0;
 315 }
 316
 317 /*
 318  * idt_smb_write_word() - SMBus write method when I2C_SMBUS_BYTE_DATA and
 319  *                        I2C_FUNC_SMBUS_WORD_DATA operations are available
 320  * @pdev:       Pointer to the driver data
 321  * @seq:        Sequence of data to be written
 322  */
 323 static int idt_smb_write_word(struct idt_89hpesx_dev *pdev,
 324                               const struct idt_smb_seq *seq)
 325 {
 326         s32 sts;
 327         u8 ccode;
 328         int idx, evencnt;
 329
 330         /* Calculate the even count of data to send */
 331         evencnt = seq->bytecnt - (seq->bytecnt % 2);
 332
 333         /* Loop over the supplied data sending two bytes at a time */
 334         for (idx = 0; idx < evencnt; idx += 2) {
 335                 /* Collect the command code byte */
 336                 ccode = seq->ccode | CCODE_WORD;
 337                 if (idx == 0)
 338                         ccode |= CCODE_START;
 339                 if (idx == evencnt - 2)
 340                         ccode |= CCODE_END;
 341
 342                 /* Send word data to the device */
 343                 sts = idt_smb_safe(write_word, pdev->client, ccode,
 344                         *(u16 *)&seq->data[idx]);
 345                 if (sts != 0)
 346                         return (int)sts;
 347         }
 348
 349         /* If there is odd number of bytes then send just one last byte */
 350         if (seq->bytecnt != evencnt) {
 351                 /* Collect the command code byte */
 352                 ccode = seq->ccode | CCODE_BYTE | CCODE_END;
 353                 if (idx == 0)
 354                         ccode |= CCODE_START;
 355
 356                 /* Send byte data to the device */
 357                 sts = idt_smb_safe(write_byte, pdev->client, ccode,
 358                         seq->data[idx]);
 359                 if (sts != 0)
 360                         return (int)sts;
 361         }
 362
 363         return 0;
 364 }
 365
 366 /*
 367  * idt_smb_read_word() - SMBus read method when I2C_SMBUS_BYTE_DATA and
 368  *                       I2C_FUNC_SMBUS_WORD_DATA operations are available
 369  * @pdev:       Pointer to the driver data
 370  * @seq:        Buffer to read data to
 371  */
 372 static int idt_smb_read_word(struct idt_89hpesx_dev *pdev,
 373                              struct idt_smb_seq *seq)
 374 {
 375         s32 sts;
 376         u8 ccode;
 377         int idx, evencnt;
 378
 379         /* Calculate the even count of data to send */
 380         evencnt = seq->bytecnt - (seq->bytecnt % 2);
 381
 382         /* Loop over the supplied data reading two bytes at a time */
 383         for (idx = 0; idx < evencnt; idx += 2) {
 384                 /* Collect the command code byte */
 385                 ccode = seq->ccode | CCODE_WORD;
 386                 if (idx == 0)
 387                         ccode |= CCODE_START;
 388                 if (idx == evencnt - 2)
 389                         ccode |= CCODE_END;
 390
 391                 /* Read word data from the device */
 392                 sts = idt_smb_safe(read_word, pdev->client, ccode);
 393                 if (sts < 0)
 394                         return (int)sts;
 395
 396                 *(u16 *)&seq->data[idx] = (u16)sts;
 397         }
 398
 399         /* If there is odd number of bytes then receive just one last byte */
 400         if (seq->bytecnt != evencnt) {
 401                 /* Collect the command code byte */
 402                 ccode = seq->ccode | CCODE_BYTE | CCODE_END;
 403                 if (idx == 0)
 404                         ccode |= CCODE_START;
 405
 406                 /* Read last data byte from the device */
 407                 sts = idt_smb_safe(read_byte, pdev->client, ccode);
 408                 if (sts < 0)
 409                         return (int)sts;
 410
 411                 seq->data[idx] = (u8)sts;
 412         }
 413
 414         return 0;
 415 }
 416
 417 /*
 418  * idt_smb_write_block() - SMBus write method when I2C_SMBUS_BLOCK_DATA
 419  *                         operation is available
 420  * @pdev:       Pointer to the driver data
 421  * @seq:        Sequence of data to be written
 422  */
 423 static int idt_smb_write_block(struct idt_89hpesx_dev *pdev,
 424                                const struct idt_smb_seq *seq)
 425 {
 426         u8 ccode;
 427
 428         /* Return error if too much data passed to send */
 429         if (seq->bytecnt > I2C_SMBUS_BLOCK_MAX)
 430                 return -EINVAL;
 431
 432         /* Collect the command code byte */
 433         ccode = seq->ccode | CCODE_BLOCK | CCODE_START | CCODE_END;
 434
 435         /* Send block of data to the device */
 436         return idt_smb_safe(write_block, pdev->client, ccode, seq->bytecnt,
 437                 seq->data);
 438 }
 439
 440 /*
 441  * idt_smb_read_block() - SMBus read method when I2C_SMBUS_BLOCK_DATA
 442  *                        operation is available
 443  * @pdev:       Pointer to the driver data
 444  * @seq:        Buffer to read data to
 445  */
 446 static int idt_smb_read_block(struct idt_89hpesx_dev *pdev,
 447                               struct idt_smb_seq *seq)
 448 {
 449         s32 sts;
 450         u8 ccode;
 451
 452         /* Return error if too much data passed to send */
 453         if (seq->bytecnt > I2C_SMBUS_BLOCK_MAX)
 454                 return -EINVAL;
 455
 456         /* Collect the command code byte */
 457         ccode = seq->ccode | CCODE_BLOCK | CCODE_START | CCODE_END;
 458
 459         /* Read block of data from the device */
 460         sts = idt_smb_safe(read_block, pdev->client, ccode, seq->data);
 461         if (sts != seq->bytecnt)
 462                 return (sts < 0 ? sts : -ENODATA);
 463
 464         return 0;
 465 }
 466
 467 /*
 468  * idt_smb_write_i2c_block() - SMBus write method when I2C_SMBUS_I2C_BLOCK_DATA
 469  *                             operation is available
 470  * @pdev:       Pointer to the driver data
 471  * @seq:        Sequence of data to be written
 472  *
 473  * NOTE It's usual SMBus write block operation, except the actual data length is
 474  * sent as first byte of data
 475  */
 476 static int idt_smb_write_i2c_block(struct idt_89hpesx_dev *pdev,
 477                                    const struct idt_smb_seq *seq)
 478 {
 479         u8 ccode, buf[I2C_SMBUS_BLOCK_MAX + 1];
 480
 481         /* Return error if too much data passed to send */
 482         if (seq->bytecnt > I2C_SMBUS_BLOCK_MAX)
 483                 return -EINVAL;
 484
 485         /* Collect the data to send. Length byte must be added prior the data */
 486         buf[0] = seq->bytecnt;
 487         memcpy(&buf[1], seq->data, seq->bytecnt);
 488
 489         /* Collect the command code byte */
 490         ccode = seq->ccode | CCODE_BLOCK | CCODE_START | CCODE_END;
 491
 492         /* Send length and block of data to the device */
 493         return idt_smb_safe(write_i2c_block, pdev->client, ccode,
 494                 seq->bytecnt + 1, buf);
 495 }
 496
 497 /*
 498  * idt_smb_read_i2c_block() - SMBus read method when I2C_SMBUS_I2C_BLOCK_DATA
 499  *                            operation is available
 500  * @pdev:       Pointer to the driver data
 501  * @seq:        Buffer to read data to
 502  *
 503  * NOTE It's usual SMBus read block operation, except the actual data length is
 504  * retrieved as first byte of data
 505  */
 506 static int idt_smb_read_i2c_block(struct idt_89hpesx_dev *pdev,
 507                                   struct idt_smb_seq *seq)
 508 {
 509         u8 ccode, buf[I2C_SMBUS_BLOCK_MAX + 1];
 510         s32 sts;
 511
 512         /* Return error if too much data passed to send */
 513         if (seq->bytecnt > I2C_SMBUS_BLOCK_MAX)
 514                 return -EINVAL;
 515
 516         /* Collect the command code byte */
 517         ccode = seq->ccode | CCODE_BLOCK | CCODE_START | CCODE_END;
 518
 519         /* Read length and block of data from the device */
 520         sts = idt_smb_safe(read_i2c_block, pdev->client, ccode,
 521                 seq->bytecnt + 1, buf);
 522         if (sts != seq->bytecnt + 1)
 523                 return (sts < 0 ? sts : -ENODATA);
 524         if (buf[0] != seq->bytecnt)
 525                 return -ENODATA;
 526
 527         /* Copy retrieved data to the output data buffer */
 528         memcpy(seq->data, &buf[1], seq->bytecnt);
 529
 530         return 0;
 531 }
 532
 533 /*===========================================================================
 534  *                          EEPROM IO-operations
 535  *===========================================================================
 536  */
 537
 538 /*
 539  * idt_eeprom_read_byte() - read just one byte from EEPROM
 540  * @pdev:       Pointer to the driver data
 541  * @memaddr:    Start EEPROM memory address
 542  * @data:       Data to be written to EEPROM
 543  */
 544 static int idt_eeprom_read_byte(struct idt_89hpesx_dev *pdev, u16 memaddr,
 545                                 u8 *data)
 546 {
 547         struct device *dev = &pdev->client->dev;
 548         struct idt_eeprom_seq eeseq;
 549         struct idt_smb_seq smbseq;
 550         int ret, retry;
 551
 552         /* Initialize SMBus sequence fields */
 553         smbseq.ccode = pdev->iniccode | CCODE_EEPROM;
 554         smbseq.data = (u8 *)&eeseq;
 555
 556         /*
 557          * Sometimes EEPROM may respond with NACK if it's busy with previous
 558          * operation, so we need to perform a few attempts of read cycle
 559          */
 560         retry = RETRY_CNT;
 561         do {
 562                 /* Send EEPROM memory address to read data from */
 563                 smbseq.bytecnt = EEPROM_WRRD_CNT;
 564                 eeseq.cmd = pdev->inieecmd | EEPROM_OP_READ;
 565                 eeseq.eeaddr = pdev->eeaddr;
 566                 eeseq.memaddr = cpu_to_le16(memaddr);
 567                 ret = pdev->smb_write(pdev, &smbseq);
 568                 if (ret != 0) {
 569                         dev_err(dev, "Failed to init eeprom addr 0x%02x",
 570                                 memaddr);
 571                         break;
 572                 }
 573
 574                 /* Perform read operation */
 575                 smbseq.bytecnt = EEPROM_RD_CNT;
 576                 ret = pdev->smb_read(pdev, &smbseq);
 577                 if (ret != 0) {
 578                         dev_err(dev, "Failed to read eeprom data 0x%02x",
 579                                 memaddr);
 580                         break;
 581                 }
 582
 583                 /* Restart read operation if the device is busy */
 584                 if (retry && (eeseq.cmd & EEPROM_NAERR)) {
 585                         dev_dbg(dev, "EEPROM busy, retry reading after %d ms",
 586                                 EEPROM_TOUT);
 587                         msleep(EEPROM_TOUT);
 588                         continue;
 589                 }
 590
 591                 /* Check whether IDT successfully read data from EEPROM */
 592                 if (eeseq.cmd & (EEPROM_NAERR | EEPROM_LAERR | EEPROM_MSS)) {
 593                         dev_err(dev,
 594                                 "Communication with eeprom failed, cmd 0x%hhx",
 595                                 eeseq.cmd);
 596                         ret = -EREMOTEIO;
 597                         break;
 598                 }
 599
 600                 /* Save retrieved data and exit the loop */
 601                 *data = eeseq.data;
 602                 break;
 603         } while (retry--);
 604
 605         /* Return the status of operation */
 606         return ret;
 607 }
 608
 609 /*
 610  * idt_eeprom_write() - EEPROM write operation
 611  * @pdev:       Pointer to the driver data
 612  * @memaddr:    Start EEPROM memory address
 613  * @len:        Length of data to be written
 614  * @data:       Data to be written to EEPROM
 615  */
 616 static int idt_eeprom_write(struct idt_89hpesx_dev *pdev, u16 memaddr, u16 len,
 617                             const u8 *data)
 618 {
 619         struct device *dev = &pdev->client->dev;
 620         struct idt_eeprom_seq eeseq;
 621         struct idt_smb_seq smbseq;
 622         int ret;
 623         u16 idx;
 624
 625         /* Initialize SMBus sequence fields */
 626         smbseq.ccode = pdev->iniccode | CCODE_EEPROM;
 627         smbseq.data = (u8 *)&eeseq;
 628
 629         /* Send data byte-by-byte, checking if it is successfully written */
 630         for (idx = 0; idx < len; idx++, memaddr++) {
 631                 /* Lock IDT SMBus device */
 632                 mutex_lock(&pdev->smb_mtx);
 633
 634                 /* Perform write operation */
 635                 smbseq.bytecnt = EEPROM_WR_CNT;
 636                 eeseq.cmd = pdev->inieecmd | EEPROM_OP_WRITE;
 637                 eeseq.eeaddr = pdev->eeaddr;
 638                 eeseq.memaddr = cpu_to_le16(memaddr);
 639                 eeseq.data = data[idx];
 640                 ret = pdev->smb_write(pdev, &smbseq);
 641                 if (ret != 0) {
 642                         dev_err(dev,
 643                                 "Failed to write 0x%04hx:0x%02hhx to eeprom",
 644                                 memaddr, data[idx]);
 645                         goto err_mutex_unlock;
 646                 }
 647
 648                 /*
 649                  * Check whether the data is successfully written by reading
 650                  * from the same EEPROM memory address.
 651                  */
 652                 eeseq.data = ~data[idx];
 653                 ret = idt_eeprom_read_byte(pdev, memaddr, &eeseq.data);
 654                 if (ret != 0)
 655                         goto err_mutex_unlock;
 656
 657                 /* Check whether the read byte is the same as written one */
 658                 if (eeseq.data != data[idx]) {
 659                         dev_err(dev, "Values don't match 0x%02hhx != 0x%02hhx",
 660                                 eeseq.data, data[idx]);
 661                         ret = -EREMOTEIO;
 662                         goto err_mutex_unlock;
 663                 }
 664
 665                 /* Unlock IDT SMBus device */
 666 err_mutex_unlock:
 667                 mutex_unlock(&pdev->smb_mtx);
 668                 if (ret != 0)
 669                         return ret;
 670         }
 671
 672         return 0;
 673 }
 674
 675 /*
 676  * idt_eeprom_read() - EEPROM read operation
 677  * @pdev:       Pointer to the driver data
 678  * @memaddr:    Start EEPROM memory address
 679  * @len:        Length of data to read
 680  * @buf:        Buffer to read data to
 681  */
 682 static int idt_eeprom_read(struct idt_89hpesx_dev *pdev, u16 memaddr, u16 len,
 683                            u8 *buf)
 684 {
 685         int ret;
 686         u16 idx;
 687
 688         /* Read data byte-by-byte, retrying if it wasn't successful */
 689         for (idx = 0; idx < len; idx++, memaddr++) {
 690                 /* Lock IDT SMBus device */
 691                 mutex_lock(&pdev->smb_mtx);
 692
 693                 /* Just read the byte to the buffer */
 694                 ret = idt_eeprom_read_byte(pdev, memaddr, &buf[idx]);
 695
 696                 /* Unlock IDT SMBus device */
 697                 mutex_unlock(&pdev->smb_mtx);
 698
 699                 /* Return error if read operation failed */
 700                 if (ret != 0)
 701                         return ret;
 702         }
 703
 704         return 0;
 705 }
 706
 707 /*===========================================================================
 708  *                          CSR IO-operations
 709  *===========================================================================
 710  */
 711
 712 /*
 713  * idt_csr_write() - CSR write operation
 714  * @pdev:       Pointer to the driver data
 715  * @csraddr:    CSR address (with no two LS bits)
 716  * @data:       Data to be written to CSR
 717  */
 718 static int idt_csr_write(struct idt_89hpesx_dev *pdev, u16 csraddr,
 719                          const u32 data)
 720 {
 721         struct device *dev = &pdev->client->dev;
 722         struct idt_csr_seq csrseq;
 723         struct idt_smb_seq smbseq;
 724         int ret;
 725
 726         /* Initialize SMBus sequence fields */
 727         smbseq.ccode = pdev->iniccode | CCODE_CSR;
 728         smbseq.data = (u8 *)&csrseq;
 729
 730         /* Lock IDT SMBus device */
 731         mutex_lock(&pdev->smb_mtx);
 732
 733         /* Perform write operation */
 734         smbseq.bytecnt = CSR_WR_CNT;
 735         csrseq.cmd = pdev->inicsrcmd | CSR_OP_WRITE;
 736         csrseq.csraddr = cpu_to_le16(csraddr);
 737         csrseq.data = cpu_to_le32(data);
 738         ret = pdev->smb_write(pdev, &smbseq);
 739         if (ret != 0) {
 740                 dev_err(dev, "Failed to write 0x%04x: 0x%04x to csr",
 741                         CSR_REAL_ADDR(csraddr), data);
 742                 goto err_mutex_unlock;
 743         }
 744
 745         /* Send CSR address to read data from */
 746         smbseq.bytecnt = CSR_WRRD_CNT;
 747         csrseq.cmd = pdev->inicsrcmd | CSR_OP_READ;
 748         ret = pdev->smb_write(pdev, &smbseq);
 749         if (ret != 0) {
 750                 dev_err(dev, "Failed to init csr address 0x%04x",
 751                         CSR_REAL_ADDR(csraddr));
 752                 goto err_mutex_unlock;
 753         }
 754
 755         /* Perform read operation */
 756         smbseq.bytecnt = CSR_RD_CNT;
 757         ret = pdev->smb_read(pdev, &smbseq);
 758         if (ret != 0) {
 759                 dev_err(dev, "Failed to read csr 0x%04x",
 760                         CSR_REAL_ADDR(csraddr));
 761                 goto err_mutex_unlock;
 762         }
 763
 764         /* Check whether IDT successfully retrieved CSR data */
 765         if (csrseq.cmd & (CSR_RERR | CSR_WERR)) {
 766                 dev_err(dev, "IDT failed to perform CSR r/w");
 767                 ret = -EREMOTEIO;
 768                 goto err_mutex_unlock;
 769         }
 770
 771         /* Unlock IDT SMBus device */
 772 err_mutex_unlock:
 773         mutex_unlock(&pdev->smb_mtx);
 774
 775         return ret;
 776 }
 777
 778 /*
 779  * idt_csr_read() - CSR read operation
 780  * @pdev:       Pointer to the driver data
 781  * @csraddr:    CSR address (with no two LS bits)
 782  * @data:       Data to be written to CSR
 783  */
 784 static int idt_csr_read(struct idt_89hpesx_dev *pdev, u16 csraddr, u32 *data)
 785 {
 786         struct device *dev = &pdev->client->dev;
 787         struct idt_csr_seq csrseq;
 788         struct idt_smb_seq smbseq;
 789         int ret;
 790
 791         /* Initialize SMBus sequence fields */
 792         smbseq.ccode = pdev->iniccode | CCODE_CSR;
 793         smbseq.data = (u8 *)&csrseq;
 794
 795         /* Lock IDT SMBus device */
 796         mutex_lock(&pdev->smb_mtx);
 797
 798         /* Send CSR register address before reading it */
 799         smbseq.bytecnt = CSR_WRRD_CNT;
 800         csrseq.cmd = pdev->inicsrcmd | CSR_OP_READ;
 801         csrseq.csraddr = cpu_to_le16(csraddr);
 802         ret = pdev->smb_write(pdev, &smbseq);
 803         if (ret != 0) {
 804                 dev_err(dev, "Failed to init csr address 0x%04x",
 805                         CSR_REAL_ADDR(csraddr));
 806                 goto err_mutex_unlock;
 807         }
 808
 809         /* Perform read operation */
 810         smbseq.bytecnt = CSR_RD_CNT;
 811         ret = pdev->smb_read(pdev, &smbseq);
 812         if (ret != 0) {
 813                 dev_err(dev, "Failed to read csr 0x%04x",
 814                         CSR_REAL_ADDR(csraddr));
 815                 goto err_mutex_unlock;
 816         }
 817
 818         /* Check whether IDT successfully retrieved CSR data */
 819         if (csrseq.cmd & (CSR_RERR | CSR_WERR)) {
 820                 dev_err(dev, "IDT failed to perform CSR r/w");
 821                 ret = -EREMOTEIO;
 822                 goto err_mutex_unlock;
 823         }
 824
 825         /* Save data retrieved from IDT */
 826         *data = le32_to_cpu(csrseq.data);
 827
 828         /* Unlock IDT SMBus device */
 829 err_mutex_unlock:
 830         mutex_unlock(&pdev->smb_mtx);
 831
 832         return ret;
 833 }
 834
 835 /*===========================================================================
 836  *                          Sysfs/debugfs-nodes IO-operations
 837  *===========================================================================
 838  */
 839
 840 /*
 841  * eeprom_write() - EEPROM sysfs-node write callback
 842  * @filep:      Pointer to the file system node
 843  * @kobj:       Pointer to the kernel object related to the sysfs-node
 844  * @attr:       Attributes of the file
 845  * @buf:        Buffer to write data to
 846  * @off:        Offset at which data should be written to
 847  * @count:      Number of bytes to write
 848  */
 849 static ssize_t eeprom_write(struct file *filp, struct kobject *kobj,
 850                             struct bin_attribute *attr,
 851                             char *buf, loff_t off, size_t count)
 852 {
 853         struct idt_89hpesx_dev *pdev;
 854         int ret;
 855
 856         /* Retrieve driver data */
 857         pdev = dev_get_drvdata(kobj_to_dev(kobj));
 858
 859         /* Perform EEPROM write operation */
 860         ret = idt_eeprom_write(pdev, (u16)off, (u16)count, (u8 *)buf);
 861         return (ret != 0 ? ret : count);
 862 }
 863
 864 /*
 865  * eeprom_read() - EEPROM sysfs-node read callback
 866  * @filep:      Pointer to the file system node
 867  * @kobj:       Pointer to the kernel object related to the sysfs-node
 868  * @attr:       Attributes of the file
 869  * @buf:        Buffer to write data to
 870  * @off:        Offset at which data should be written to
 871  * @count:      Number of bytes to write
 872  */
 873 static ssize_t eeprom_read(struct file *filp, struct kobject *kobj,
 874                            struct bin_attribute *attr,
 875                            char *buf, loff_t off, size_t count)
 876 {
 877         struct idt_89hpesx_dev *pdev;
 878         int ret;
 879
 880         /* Retrieve driver data */
 881         pdev = dev_get_drvdata(kobj_to_dev(kobj));
 882
 883         /* Perform EEPROM read operation */
 884         ret = idt_eeprom_read(pdev, (u16)off, (u16)count, (u8 *)buf);
 885         return (ret != 0 ? ret : count);
 886 }
 887
 888 /*
 889  * idt_dbgfs_csr_write() - CSR debugfs-node write callback
 890  * @filep:      Pointer to the file system file descriptor
 891  * @buf:        Buffer to read data from
 892  * @count:      Size of the buffer
 893  * @offp:       Offset within the file
 894  *
 895  * It accepts either "0x<reg addr>:0x<value>" for saving register address
 896  * and writing value to specified DWORD register or "0x<reg addr>" for
 897  * just saving register address in order to perform next read operation.
 898  *
 899  * WARNING No spaces are allowed. Incoming string must be strictly formated as:
 900  * "<reg addr>:<value>". Register address must be aligned within 4 bytes
 901  * (one DWORD).
 902  */
 903 static ssize_t idt_dbgfs_csr_write(struct file *filep, const char __user *ubuf,
 904                                    size_t count, loff_t *offp)
 905 {
 906         struct idt_89hpesx_dev *pdev = filep->private_data;
 907         char *colon_ch, *csraddr_str, *csrval_str;
 908         int ret, csraddr_len;
 909         u32 csraddr, csrval;
 910         char *buf;
 911
 912         if (*offp)
 913                 return 0;
 914
 915         /* Copy data from User-space */
 916         buf = kmalloc(count + 1, GFP_KERNEL);
 917         if (!buf)
 918                 return -ENOMEM;
 919
 920         if (copy_from_user(buf, ubuf, count)) {
 921                 ret = -EFAULT;
 922                 goto free_buf;
 923         }
 924         buf[count] = 0;
 925
 926         /* Find position of colon in the buffer */
 927         colon_ch = strnchr(buf, count, ':');
 928
 929         /*
 930          * If there is colon passed then new CSR value should be parsed as
 931          * well, so allocate buffer for CSR address substring.
 932          * If no colon is found, then string must have just one number with
 933          * no new CSR value
 934          */
 935         if (colon_ch != NULL) {
 936                 csraddr_len = colon_ch - buf;
 937                 csraddr_str =
 938                         kmalloc(csraddr_len + 1, GFP_KERNEL);
 939                 if (csraddr_str == NULL) {
 940                         ret = -ENOMEM;
 941                         goto free_buf;
 942                 }
 943                 /* Copy the register address to the substring buffer */
 944                 strncpy(csraddr_str, buf, csraddr_len);
 945                 csraddr_str[csraddr_len] = '\0';
 946                 /* Register value must follow the colon */
 947                 csrval_str = colon_ch + 1;
 948         } else /* if (str_colon == NULL) */ {
 949                 csraddr_str = (char *)buf; /* Just to shut warning up */
 950                 csraddr_len = strnlen(csraddr_str, count);
 951                 csrval_str = NULL;
 952         }
 953
 954         /* Convert CSR address to u32 value */
 955         ret = kstrtou32(csraddr_str, 0, &csraddr);
 956         if (ret != 0)
 957                 goto free_csraddr_str;
 958
 959         /* Check whether passed register address is valid */
 960         if (csraddr > CSR_MAX || !IS_ALIGNED(csraddr, SZ_4)) {
 961                 ret = -EINVAL;
 962                 goto free_csraddr_str;
 963         }
 964
 965         /* Shift register address to the right so to have u16 address */
 966         pdev->csr = (csraddr >> 2);
 967
 968         /* Parse new CSR value and send it to IDT, if colon has been found */
 969         if (colon_ch != NULL) {
 970                 ret = kstrtou32(csrval_str, 0, &csrval);
 971                 if (ret != 0)
 972                         goto free_csraddr_str;
 973
 974                 ret = idt_csr_write(pdev, pdev->csr, csrval);
 975                 if (ret != 0)
 976                         goto free_csraddr_str;
 977         }
 978
 979         /* Free memory only if colon has been found */
 980 free_csraddr_str:
 981         if (colon_ch != NULL)
 982                 kfree(csraddr_str);
 983
 984         /* Free buffer allocated for data retrieved from User-space */
 985 free_buf:
 986         kfree(buf);
 987
 988         return (ret != 0 ? ret : count);
 989 }
 990
 991 /*
 992  * idt_dbgfs_csr_read() - CSR debugfs-node read callback
 993  * @filep:      Pointer to the file system file descriptor
 994  * @buf:        Buffer to write data to
 995  * @count:      Size of the buffer
 996  * @offp:       Offset within the file
 997  *
 998  * It just prints the pair "0x<reg addr>:0x<value>" to passed buffer.
 999  */
1000 #define CSRBUF_SIZE     ((size_t)32)
1001 static ssize_t idt_dbgfs_csr_read(struct file *filep, char __user *ubuf,
1002                                   size_t count, loff_t *offp)
1003 {
1004         struct idt_89hpesx_dev *pdev = filep->private_data;
1005         u32 csraddr, csrval;
1006         char buf[CSRBUF_SIZE];
1007         int ret, size;
1008
1009         /* Perform CSR read operation */
1010         ret = idt_csr_read(pdev, pdev->csr, &csrval);
1011         if (ret != 0)
1012                 return ret;
1013
1014         /* Shift register address to the left so to have real address */
1015         csraddr = ((u32)pdev->csr << 2);
1016
1017         /* Print the "0x<reg addr>:0x<value>" to buffer */
1018         size = snprintf(buf, CSRBUF_SIZE, "0x%05x:0x%08x\n",
1019                 (unsigned int)csraddr, (unsigned int)csrval);
1020
1021         /* Copy data to User-space */
1022         return simple_read_from_buffer(ubuf, count, offp, buf, size);
1023 }
1024
1025 /*
1026  * eeprom_attribute - EEPROM sysfs-node attributes
1027  *
1028  * NOTE Size will be changed in compliance with OF node. EEPROM attribute will
1029  * be read-only as well if the corresponding flag is specified in OF node.
1030  */
1031 static BIN_ATTR_RW(eeprom, EEPROM_DEF_SIZE);
1032
1033 /*
1034  * csr_dbgfs_ops - CSR debugfs-node read/write operations
1035  */
1036 static const struct file_operations csr_dbgfs_ops = {
1037         .owner = THIS_MODULE,
1038         .open = simple_open,
1039         .write = idt_dbgfs_csr_write,
1040         .read = idt_dbgfs_csr_read
1041 };
1042
1043 /*===========================================================================
1044  *                       Driver init/deinit methods
1045  *===========================================================================
1046  */
1047
1048 /*
1049  * idt_set_defval() - disable EEPROM access by default
1050  * @pdev:       Pointer to the driver data
1051  */
1052 static void idt_set_defval(struct idt_89hpesx_dev *pdev)
1053 {
1054         /* If OF info is missing then use next values */
1055         pdev->eesize = 0;
1056         pdev->eero = true;
1057         pdev->inieecmd = 0;
1058         pdev->eeaddr = 0;
1059 }
1060
1061 static const struct i2c_device_id ee_ids[];
1062
1063 /*
1064  * idt_ee_match_id() - check whether the node belongs to compatible EEPROMs
1065  */
1066 static const struct i2c_device_id *idt_ee_match_id(struct fwnode_handle *fwnode)
1067 {
1068         const struct i2c_device_id *id = ee_ids;
1069         const char *compatible, *p;
1070         char devname[I2C_NAME_SIZE];
1071         int ret;
1072
1073         ret = fwnode_property_read_string(fwnode, "compatible", &compatible);
1074         if (ret)
1075                 return NULL;
1076
1077         p = strchr(compatible, ',');
1078         strscpy(devname, p ? p + 1 : compatible, sizeof(devname));
1079         /* Search through the device name */
1080         while (id->name[0]) {
1081                 if (strcmp(devname, id->name) == 0)
1082                         return id;
1083                 id++;
1084         }
1085         return NULL;
1086 }
1087
1088 /*
1089  * idt_get_fw_data() - get IDT i2c-device parameters from device tree
1090  * @pdev:       Pointer to the driver data
1091  */
1092 static void idt_get_fw_data(struct idt_89hpesx_dev *pdev)
1093 {
1094         struct device *dev = &pdev->client->dev;
1095         struct fwnode_handle *fwnode;
1096         const struct i2c_device_id *ee_id = NULL;
1097         u32 eeprom_addr;
1098         int ret;
1099
1100         device_for_each_child_node(dev, fwnode) {
1101                 ee_id = idt_ee_match_id(fwnode);
1102                 if (ee_id)
1103                         break;
1104
1105                 dev_warn(dev, "Skip unsupported EEPROM device %pfw\n", fwnode);
1106         }
1107
1108         /* If there is no fwnode EEPROM device, then set zero size */
1109         if (!ee_id) {
1110                 dev_warn(dev, "No fwnode, EEPROM access disabled");
1111                 idt_set_defval(pdev);
1112                 return;
1113         }
1114
1115         /* Retrieve EEPROM size */
1116         pdev->eesize = (u32)ee_id->driver_data;
1117
1118         /* Get custom EEPROM address from 'reg' attribute */
1119         ret = fwnode_property_read_u32(fwnode, "reg", &eeprom_addr);
1120         if (ret || (eeprom_addr == 0)) {
1121                 dev_warn(dev, "No EEPROM reg found, use default address 0x%x",
1122                          EEPROM_DEF_ADDR);
1123                 pdev->inieecmd = 0;
1124                 pdev->eeaddr = EEPROM_DEF_ADDR << 1;
1125         } else {
1126                 pdev->inieecmd = EEPROM_USA;
1127                 pdev->eeaddr = eeprom_addr << 1;
1128         }
1129
1130         /* Check EEPROM 'read-only' flag */
1131         if (fwnode_property_read_bool(fwnode, "read-only"))
1132                 pdev->eero = true;
1133         else /* if (!fwnode_property_read_bool(node, "read-only")) */
1134                 pdev->eero = false;
1135
1136         fwnode_handle_put(fwnode);
1137         dev_info(dev, "EEPROM of %d bytes found by 0x%x",
1138                 pdev->eesize, pdev->eeaddr);
1139 }
1140
1141 /*
1142  * idt_create_pdev() - create and init data structure of the driver
1143  * @client:     i2c client of IDT PCIe-switch device
1144  */
1145 static struct idt_89hpesx_dev *idt_create_pdev(struct i2c_client *client)
1146 {
1147         struct idt_89hpesx_dev *pdev;
1148
1149         /* Allocate memory for driver data */
1150         pdev = devm_kmalloc(&client->dev, sizeof(struct idt_89hpesx_dev),
1151                 GFP_KERNEL);
1152         if (pdev == NULL)
1153                 return ERR_PTR(-ENOMEM);
1154
1155         /* Initialize basic fields of the data */
1156         pdev->client = client;
1157         i2c_set_clientdata(client, pdev);
1158
1159         /* Read firmware nodes information */
1160         idt_get_fw_data(pdev);
1161
1162         /* Initialize basic CSR CMD field - use full DWORD-sized r/w ops */
1163         pdev->inicsrcmd = CSR_DWE;
1164         pdev->csr = CSR_DEF;
1165
1166         /* Enable Packet Error Checking if it's supported by adapter */
1167         if (i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_PEC)) {
1168                 pdev->iniccode = CCODE_PEC;
1169                 client->flags |= I2C_CLIENT_PEC;
1170         } else /* PEC is unsupported */ {
1171                 pdev->iniccode = 0;
1172         }
1173
1174         return pdev;
1175 }
1176
1177 /*
1178  * idt_free_pdev() - free data structure of the driver
1179  * @pdev:       Pointer to the driver data
1180  */
1181 static void idt_free_pdev(struct idt_89hpesx_dev *pdev)
1182 {
1183         /* Clear driver data from device private field */
1184         i2c_set_clientdata(pdev->client, NULL);
1185 }
1186
1187 /*
1188  * idt_set_smbus_ops() - set supported SMBus operations
1189  * @pdev:       Pointer to the driver data
1190  * Return status of smbus check operations
1191  */
1192 static int idt_set_smbus_ops(struct idt_89hpesx_dev *pdev)
1193 {
1194         struct i2c_adapter *adapter = pdev->client->adapter;
1195         struct device *dev = &pdev->client->dev;
1196
1197         /* Check i2c adapter read functionality */
1198         if (i2c_check_functionality(adapter,
1199                                     I2C_FUNC_SMBUS_READ_BLOCK_DATA)) {
1200                 pdev->smb_read = idt_smb_read_block;
1201                 dev_dbg(dev, "SMBus block-read op chosen");
1202         } else if (i2c_check_functionality(adapter,
1203                                            I2C_FUNC_SMBUS_READ_I2C_BLOCK)) {
1204                 pdev->smb_read = idt_smb_read_i2c_block;
1205                 dev_dbg(dev, "SMBus i2c-block-read op chosen");
1206         } else if (i2c_check_functionality(adapter,
1207                                            I2C_FUNC_SMBUS_READ_WORD_DATA) &&
1208                    i2c_check_functionality(adapter,
1209                                            I2C_FUNC_SMBUS_READ_BYTE_DATA)) {
1210                 pdev->smb_read = idt_smb_read_word;
1211                 dev_warn(dev, "Use slow word/byte SMBus read ops");
1212         } else if (i2c_check_functionality(adapter,
1213                                            I2C_FUNC_SMBUS_READ_BYTE_DATA)) {
1214                 pdev->smb_read = idt_smb_read_byte;
1215                 dev_warn(dev, "Use slow byte SMBus read op");
1216         } else /* no supported smbus read operations */ {
1217                 dev_err(dev, "No supported SMBus read op");
1218                 return -EPFNOSUPPORT;
1219         }
1220
1221         /* Check i2c adapter write functionality */
1222         if (i2c_check_functionality(adapter,
1223                                     I2C_FUNC_SMBUS_WRITE_BLOCK_DATA)) {
1224                 pdev->smb_write = idt_smb_write_block;
1225                 dev_dbg(dev, "SMBus block-write op chosen");
1226         } else if (i2c_check_functionality(adapter,
1227                                            I2C_FUNC_SMBUS_WRITE_I2C_BLOCK)) {
1228                 pdev->smb_write = idt_smb_write_i2c_block;
1229                 dev_dbg(dev, "SMBus i2c-block-write op chosen");
1230         } else if (i2c_check_functionality(adapter,
1231                                            I2C_FUNC_SMBUS_WRITE_WORD_DATA) &&
1232                    i2c_check_functionality(adapter,
1233                                            I2C_FUNC_SMBUS_WRITE_BYTE_DATA)) {
1234                 pdev->smb_write = idt_smb_write_word;
1235                 dev_warn(dev, "Use slow word/byte SMBus write op");
1236         } else if (i2c_check_functionality(adapter,
1237                                            I2C_FUNC_SMBUS_WRITE_BYTE_DATA)) {
1238                 pdev->smb_write = idt_smb_write_byte;
1239                 dev_warn(dev, "Use slow byte SMBus write op");
1240         } else /* no supported smbus write operations */ {
1241                 dev_err(dev, "No supported SMBus write op");
1242                 return -EPFNOSUPPORT;
1243         }
1244
1245         /* Initialize IDT SMBus slave interface mutex */
1246         mutex_init(&pdev->smb_mtx);
1247
1248         return 0;
1249 }
1250
1251 /*
1252  * idt_check_dev() - check whether it's really IDT 89HPESx device
1253  * @pdev:       Pointer to the driver data
1254  * Return status of i2c adapter check operation
1255  */
1256 static int idt_check_dev(struct idt_89hpesx_dev *pdev)
1257 {
1258         struct device *dev = &pdev->client->dev;
1259         u32 viddid;
1260         int ret;
1261
1262         /* Read VID and DID directly from IDT memory space */
1263         ret = idt_csr_read(pdev, IDT_VIDDID_CSR, &viddid);
1264         if (ret != 0) {
1265                 dev_err(dev, "Failed to read VID/DID");
1266                 return ret;
1267         }
1268
1269         /* Check whether it's IDT device */
1270         if ((viddid & IDT_VID_MASK) != PCI_VENDOR_ID_IDT) {
1271                 dev_err(dev, "Got unsupported VID/DID: 0x%08x", viddid);
1272                 return -ENODEV;
1273         }
1274
1275         dev_info(dev, "Found IDT 89HPES device VID:0x%04x, DID:0x%04x",
1276                 (viddid & IDT_VID_MASK), (viddid >> 16));
1277
1278         return 0;
1279 }
1280
1281 /*
1282  * idt_create_sysfs_files() - create sysfs attribute files
1283  * @pdev:       Pointer to the driver data
1284  * Return status of operation
1285  */
1286 static int idt_create_sysfs_files(struct idt_89hpesx_dev *pdev)
1287 {
1288         struct device *dev = &pdev->client->dev;
1289         int ret;
1290
1291         /* Don't do anything if EEPROM isn't accessible */
1292         if (pdev->eesize == 0) {
1293                 dev_dbg(dev, "Skip creating sysfs-files");
1294                 return 0;
1295         }
1296
1297         /* Allocate memory for attribute file */
1298         pdev->ee_file = devm_kmalloc(dev, sizeof(*pdev->ee_file), GFP_KERNEL);
1299         if (!pdev->ee_file)
1300                 return -ENOMEM;
1301
1302         /* Copy the declared EEPROM attr structure to change some of fields */
1303         memcpy(pdev->ee_file, &bin_attr_eeprom, sizeof(*pdev->ee_file));
1304
1305         /* In case of read-only EEPROM get rid of write ability */
1306         if (pdev->eero) {
1307                 pdev->ee_file->attr.mode &= ~0200;
1308                 pdev->ee_file->write = NULL;
1309         }
1310         /* Create EEPROM sysfs file */
1311         pdev->ee_file->size = pdev->eesize;
1312         ret = sysfs_create_bin_file(&dev->kobj, pdev->ee_file);
1313         if (ret != 0) {
1314                 dev_err(dev, "Failed to create EEPROM sysfs-node");
1315                 return ret;
1316         }
1317
1318         return 0;
1319 }
1320
1321 /*
1322  * idt_remove_sysfs_files() - remove sysfs attribute files
1323  * @pdev:       Pointer to the driver data
1324  */
1325 static void idt_remove_sysfs_files(struct idt_89hpesx_dev *pdev)
1326 {
1327         struct device *dev = &pdev->client->dev;
1328
1329         /* Don't do anything if EEPROM wasn't accessible */
1330         if (pdev->eesize == 0)
1331                 return;
1332
1333         /* Remove EEPROM sysfs file */
1334         sysfs_remove_bin_file(&dev->kobj, pdev->ee_file);
1335 }
1336
1337 /*
1338  * idt_create_dbgfs_files() - create debugfs files
1339  * @pdev:       Pointer to the driver data
1340  */
1341 #define CSRNAME_LEN     ((size_t)32)
1342 static void idt_create_dbgfs_files(struct idt_89hpesx_dev *pdev)
1343 {
1344         struct i2c_client *cli = pdev->client;
1345         char fname[CSRNAME_LEN];
1346
1347         /* Create Debugfs directory for CSR file */
1348         snprintf(fname, CSRNAME_LEN, "%d-%04hx", cli->adapter->nr, cli->addr);
1349         pdev->csr_dir = debugfs_create_dir(fname, csr_dbgdir);
1350
1351         /* Create Debugfs file for CSR read/write operations */
1352         debugfs_create_file(cli->name, 0600, pdev->csr_dir, pdev,
1353                             &csr_dbgfs_ops);
1354 }
1355
1356 /*
1357  * idt_remove_dbgfs_files() - remove debugfs files
1358  * @pdev:       Pointer to the driver data
1359  */
1360 static void idt_remove_dbgfs_files(struct idt_89hpesx_dev *pdev)
1361 {
1362         /* Remove CSR directory and it sysfs-node */
1363         debugfs_remove_recursive(pdev->csr_dir);
1364 }
1365
1366 /*
1367  * idt_probe() - IDT 89HPESx driver probe() callback method
1368  */
1369 static int idt_probe(struct i2c_client *client)
1370 {
1371         struct idt_89hpesx_dev *pdev;
1372         int ret;
1373
1374         /* Create driver data */
1375         pdev = idt_create_pdev(client);
1376         if (IS_ERR(pdev))
1377                 return PTR_ERR(pdev);
1378
1379         /* Set SMBus operations */
1380         ret = idt_set_smbus_ops(pdev);
1381         if (ret != 0)
1382                 goto err_free_pdev;
1383
1384         /* Check whether it is truly IDT 89HPESx device */
1385         ret = idt_check_dev(pdev);
1386         if (ret != 0)
1387                 goto err_free_pdev;
1388
1389         /* Create sysfs files */
1390         ret = idt_create_sysfs_files(pdev);
1391         if (ret != 0)
1392                 goto err_free_pdev;
1393
1394         /* Create debugfs files */
1395         idt_create_dbgfs_files(pdev);
1396
1397         return 0;
1398
1399 err_free_pdev:
1400         idt_free_pdev(pdev);
1401
1402         return ret;
1403 }
1404
1405 /*
1406  * idt_remove() - IDT 89HPESx driver remove() callback method
1407  */
1408 static void idt_remove(struct i2c_client *client)
1409 {
1410         struct idt_89hpesx_dev *pdev = i2c_get_clientdata(client);
1411
1412         /* Remove debugfs files first */
1413         idt_remove_dbgfs_files(pdev);
1414
1415         /* Remove sysfs files */
1416         idt_remove_sysfs_files(pdev);
1417
1418         /* Discard driver data structure */
1419         idt_free_pdev(pdev);
1420 }
1421
1422 /*
1423  * ee_ids - array of supported EEPROMs
1424  */
1425 static const struct i2c_device_id ee_ids[] = {
1426         { "24c32",  4096},
1427         { "24c64",  8192},
1428         { "24c128", 16384},
1429         { "24c256", 32768},
1430         { "24c512", 65536},
1431         {}
1432 };
1433 MODULE_DEVICE_TABLE(i2c, ee_ids);
1434
1435 /*
1436  * idt_ids - supported IDT 89HPESx devices
1437  */
1438 static const struct i2c_device_id idt_ids[] = {
1439         { "89hpes8nt2", 0 },
1440         { "89hpes12nt3", 0 },
1441
1442         { "89hpes24nt6ag2", 0 },
1443         { "89hpes32nt8ag2", 0 },
1444         { "89hpes32nt8bg2", 0 },
1445         { "89hpes12nt12g2", 0 },
1446         { "89hpes16nt16g2", 0 },
1447         { "89hpes24nt24g2", 0 },
1448         { "89hpes32nt24ag2", 0 },
1449         { "89hpes32nt24bg2", 0 },
1450
1451         { "89hpes12n3", 0 },
1452         { "89hpes12n3a", 0 },
1453         { "89hpes24n3", 0 },
1454         { "89hpes24n3a", 0 },
1455
1456         { "89hpes32h8", 0 },
1457         { "89hpes32h8g2", 0 },
1458         { "89hpes48h12", 0 },
1459         { "89hpes48h12g2", 0 },
1460         { "89hpes48h12ag2", 0 },
1461         { "89hpes16h16", 0 },
1462         { "89hpes22h16", 0 },
1463         { "89hpes22h16g2", 0 },
1464         { "89hpes34h16", 0 },
1465         { "89hpes34h16g2", 0 },
1466         { "89hpes64h16", 0 },
1467         { "89hpes64h16g2", 0 },
1468         { "89hpes64h16ag2", 0 },
1469
1470         /* { "89hpes3t3", 0 }, // No SMBus-slave iface */
1471         { "89hpes12t3g2", 0 },
1472         { "89hpes24t3g2", 0 },
1473         /* { "89hpes4t4", 0 }, // No SMBus-slave iface */
1474         { "89hpes16t4", 0 },
1475         { "89hpes4t4g2", 0 },
1476         { "89hpes10t4g2", 0 },
1477         { "89hpes16t4g2", 0 },
1478         { "89hpes16t4ag2", 0 },
1479         { "89hpes5t5", 0 },
1480         { "89hpes6t5", 0 },
1481         { "89hpes8t5", 0 },
1482         { "89hpes8t5a", 0 },
1483         { "89hpes24t6", 0 },
1484         { "89hpes6t6g2", 0 },
1485         { "89hpes24t6g2", 0 },
1486         { "89hpes16t7", 0 },
1487         { "89hpes32t8", 0 },
1488         { "89hpes32t8g2", 0 },
1489         { "89hpes48t12", 0 },
1490         { "89hpes48t12g2", 0 },
1491         { /* END OF LIST */ }
1492 };
1493 MODULE_DEVICE_TABLE(i2c, idt_ids);
1494
1495 static const struct of_device_id idt_of_match[] = {
1496         { .compatible = "idt,89hpes8nt2", },
1497         { .compatible = "idt,89hpes12nt3", },
1498
1499         { .compatible = "idt,89hpes24nt6ag2", },
1500         { .compatible = "idt,89hpes32nt8ag2", },
1501         { .compatible = "idt,89hpes32nt8bg2", },
1502         { .compatible = "idt,89hpes12nt12g2", },
1503         { .compatible = "idt,89hpes16nt16g2", },
1504         { .compatible = "idt,89hpes24nt24g2", },
1505         { .compatible = "idt,89hpes32nt24ag2", },
1506         { .compatible = "idt,89hpes32nt24bg2", },
1507
1508         { .compatible = "idt,89hpes12n3", },
1509         { .compatible = "idt,89hpes12n3a", },
1510         { .compatible = "idt,89hpes24n3", },
1511         { .compatible = "idt,89hpes24n3a", },
1512
1513         { .compatible = "idt,89hpes32h8", },
1514         { .compatible = "idt,89hpes32h8g2", },
1515         { .compatible = "idt,89hpes48h12", },
1516         { .compatible = "idt,89hpes48h12g2", },
1517         { .compatible = "idt,89hpes48h12ag2", },
1518         { .compatible = "idt,89hpes16h16", },
1519         { .compatible = "idt,89hpes22h16", },
1520         { .compatible = "idt,89hpes22h16g2", },
1521         { .compatible = "idt,89hpes34h16", },
1522         { .compatible = "idt,89hpes34h16g2", },
1523         { .compatible = "idt,89hpes64h16", },
1524         { .compatible = "idt,89hpes64h16g2", },
1525         { .compatible = "idt,89hpes64h16ag2", },
1526
1527         { .compatible = "idt,89hpes12t3g2", },
1528         { .compatible = "idt,89hpes24t3g2", },
1529
1530         { .compatible = "idt,89hpes16t4", },
1531         { .compatible = "idt,89hpes4t4g2", },
1532         { .compatible = "idt,89hpes10t4g2", },
1533         { .compatible = "idt,89hpes16t4g2", },
1534         { .compatible = "idt,89hpes16t4ag2", },
1535         { .compatible = "idt,89hpes5t5", },
1536         { .compatible = "idt,89hpes6t5", },
1537         { .compatible = "idt,89hpes8t5", },
1538         { .compatible = "idt,89hpes8t5a", },
1539         { .compatible = "idt,89hpes24t6", },
1540         { .compatible = "idt,89hpes6t6g2", },
1541         { .compatible = "idt,89hpes24t6g2", },
1542         { .compatible = "idt,89hpes16t7", },
1543         { .compatible = "idt,89hpes32t8", },
1544         { .compatible = "idt,89hpes32t8g2", },
1545         { .compatible = "idt,89hpes48t12", },
1546         { .compatible = "idt,89hpes48t12g2", },
1547         { },
1548 };
1549 MODULE_DEVICE_TABLE(of, idt_of_match);
1550
1551 /*
1552  * idt_driver - IDT 89HPESx driver structure
1553  */
1554 static struct i2c_driver idt_driver = {
1555         .driver = {
1556                 .name = IDT_NAME,
1557                 .of_match_table = idt_of_match,
1558         },
1559         .probe = idt_probe,
1560         .remove = idt_remove,
1561         .id_table = idt_ids,
1562 };
1563
1564 /*
1565  * idt_init() - IDT 89HPESx driver init() callback method
1566  */
1567 static int __init idt_init(void)
1568 {
1569         int ret;
1570
1571         /* Create Debugfs directory first */
1572         if (debugfs_initialized())
1573                 csr_dbgdir = debugfs_create_dir("idt_csr", NULL);
1574
1575         /* Add new i2c-device driver */
1576         ret = i2c_add_driver(&idt_driver);
1577         if (ret) {
1578                 debugfs_remove_recursive(csr_dbgdir);
1579                 return ret;
1580         }
1581
1582         return 0;
1583 }
1584 module_init(idt_init);
1585
1586 /*
1587  * idt_exit() - IDT 89HPESx driver exit() callback method
1588  */
1589 static void __exit idt_exit(void)
1590 {
1591         /* Discard debugfs directory and all files if any */
1592         debugfs_remove_recursive(csr_dbgdir);
1593
1594         /* Unregister i2c-device driver */
1595         i2c_del_driver(&idt_driver);
1596 }
1597 module_exit(idt_exit);