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); 1598