| .. | .. |
|---|
| 1 | | -/* Driver for Realtek PCI-Express card reader |
|---|
| 1 | +// SPDX-License-Identifier: GPL-2.0+ |
|---|
| 2 | +/* |
|---|
| 3 | + * Driver for Realtek PCI-Express card reader |
|---|
| 2 | 4 | * |
|---|
| 3 | 5 | * Copyright(c) 2009-2013 Realtek Semiconductor Corp. All rights reserved. |
|---|
| 4 | | - * |
|---|
| 5 | | - * This program is free software; you can redistribute it and/or modify it |
|---|
| 6 | | - * under the terms of the GNU General Public License as published by the |
|---|
| 7 | | - * Free Software Foundation; either version 2, or (at your option) any |
|---|
| 8 | | - * later version. |
|---|
| 9 | | - * |
|---|
| 10 | | - * This program is distributed in the hope that it will be useful, but |
|---|
| 11 | | - * WITHOUT ANY WARRANTY; without even the implied warranty of |
|---|
| 12 | | - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
|---|
| 13 | | - * General Public License for more details. |
|---|
| 14 | | - * |
|---|
| 15 | | - * You should have received a copy of the GNU General Public License along |
|---|
| 16 | | - * with this program; if not, see <http://www.gnu.org/licenses/>. |
|---|
| 17 | 6 | * |
|---|
| 18 | 7 | * Author: |
|---|
| 19 | 8 | * Wei WANG (wei_wang@realsil.com.cn) |
|---|
| .. | .. |
|---|
| 41 | 30 | retval = rtsx_write_register(chip, SPI_CONTROL, 0xFF, |
|---|
| 42 | 31 | CS_POLARITY_LOW | DTO_MSB_FIRST |
|---|
| 43 | 32 | | SPI_MASTER | SPI_MODE0 | SPI_AUTO); |
|---|
| 44 | | - if (retval) { |
|---|
| 33 | + if (retval) |
|---|
| 45 | 34 | return retval; |
|---|
| 46 | | - } |
|---|
| 47 | 35 | retval = rtsx_write_register(chip, SPI_TCTL, EDO_TIMING_MASK, |
|---|
| 48 | 36 | SAMPLE_DELAY_HALF); |
|---|
| 49 | | - if (retval) { |
|---|
| 37 | + if (retval) |
|---|
| 50 | 38 | return retval; |
|---|
| 51 | | - } |
|---|
| 52 | 39 | |
|---|
| 53 | 40 | return STATUS_SUCCESS; |
|---|
| 54 | 41 | } |
|---|
| .. | .. |
|---|
| 60 | 47 | |
|---|
| 61 | 48 | retval = rtsx_write_register(chip, SPI_CLK_DIVIDER1, 0xFF, |
|---|
| 62 | 49 | (u8)(spi->clk_div >> 8)); |
|---|
| 63 | | - if (retval) { |
|---|
| 50 | + if (retval) |
|---|
| 64 | 51 | return retval; |
|---|
| 65 | | - } |
|---|
| 66 | 52 | retval = rtsx_write_register(chip, SPI_CLK_DIVIDER0, 0xFF, |
|---|
| 67 | 53 | (u8)(spi->clk_div)); |
|---|
| 68 | | - if (retval) { |
|---|
| 54 | + if (retval) |
|---|
| 69 | 55 | return retval; |
|---|
| 70 | | - } |
|---|
| 71 | 56 | |
|---|
| 72 | 57 | retval = switch_clock(chip, spi->spi_clock); |
|---|
| 73 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 58 | + if (retval != STATUS_SUCCESS) |
|---|
| 74 | 59 | return STATUS_FAIL; |
|---|
| 75 | | - } |
|---|
| 76 | 60 | |
|---|
| 77 | 61 | retval = select_card(chip, SPI_CARD); |
|---|
| 78 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 62 | + if (retval != STATUS_SUCCESS) |
|---|
| 79 | 63 | return STATUS_FAIL; |
|---|
| 80 | | - } |
|---|
| 81 | 64 | |
|---|
| 82 | 65 | retval = rtsx_write_register(chip, CARD_CLK_EN, SPI_CLK_EN, |
|---|
| 83 | 66 | SPI_CLK_EN); |
|---|
| 84 | | - if (retval) { |
|---|
| 67 | + if (retval) |
|---|
| 85 | 68 | return retval; |
|---|
| 86 | | - } |
|---|
| 87 | 69 | retval = rtsx_write_register(chip, CARD_OE, SPI_OUTPUT_EN, |
|---|
| 88 | 70 | SPI_OUTPUT_EN); |
|---|
| 89 | | - if (retval) { |
|---|
| 71 | + if (retval) |
|---|
| 90 | 72 | return retval; |
|---|
| 91 | | - } |
|---|
| 92 | 73 | |
|---|
| 93 | 74 | wait_timeout(10); |
|---|
| 94 | 75 | |
|---|
| 95 | 76 | retval = spi_init(chip); |
|---|
| 96 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 77 | + if (retval != STATUS_SUCCESS) |
|---|
| 97 | 78 | return STATUS_FAIL; |
|---|
| 98 | | - } |
|---|
| 99 | 79 | |
|---|
| 100 | 80 | return STATUS_SUCCESS; |
|---|
| 101 | 81 | } |
|---|
| .. | .. |
|---|
| 247 | 227 | clk = CLK_30; |
|---|
| 248 | 228 | |
|---|
| 249 | 229 | retval = rtsx_write_register(chip, SPI_CLK_DIVIDER1, 0xFF, 0x00); |
|---|
| 250 | | - if (retval) { |
|---|
| 230 | + if (retval) |
|---|
| 251 | 231 | return retval; |
|---|
| 252 | | - } |
|---|
| 253 | 232 | retval = rtsx_write_register(chip, SPI_CLK_DIVIDER0, 0xFF, 0x27); |
|---|
| 254 | | - if (retval) { |
|---|
| 233 | + if (retval) |
|---|
| 255 | 234 | return retval; |
|---|
| 256 | | - } |
|---|
| 257 | 235 | |
|---|
| 258 | 236 | retval = switch_clock(chip, clk); |
|---|
| 259 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 237 | + if (retval != STATUS_SUCCESS) |
|---|
| 260 | 238 | return STATUS_FAIL; |
|---|
| 261 | | - } |
|---|
| 262 | 239 | |
|---|
| 263 | 240 | retval = select_card(chip, SPI_CARD); |
|---|
| 264 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 241 | + if (retval != STATUS_SUCCESS) |
|---|
| 265 | 242 | return STATUS_FAIL; |
|---|
| 266 | | - } |
|---|
| 267 | 243 | |
|---|
| 268 | 244 | retval = rtsx_write_register(chip, CARD_CLK_EN, SPI_CLK_EN, |
|---|
| 269 | 245 | SPI_CLK_EN); |
|---|
| 270 | | - if (retval) { |
|---|
| 246 | + if (retval) |
|---|
| 271 | 247 | return retval; |
|---|
| 272 | | - } |
|---|
| 273 | 248 | retval = rtsx_write_register(chip, CARD_OE, SPI_OUTPUT_EN, |
|---|
| 274 | 249 | SPI_OUTPUT_EN); |
|---|
| 275 | | - if (retval) { |
|---|
| 250 | + if (retval) |
|---|
| 276 | 251 | return retval; |
|---|
| 277 | | - } |
|---|
| 278 | 252 | |
|---|
| 279 | 253 | wait_timeout(10); |
|---|
| 280 | 254 | |
|---|
| 281 | 255 | retval = rtsx_write_register(chip, SPI_CONTROL, 0xFF, |
|---|
| 282 | 256 | CS_POLARITY_HIGH | SPI_EEPROM_AUTO); |
|---|
| 283 | | - if (retval) { |
|---|
| 257 | + if (retval) |
|---|
| 284 | 258 | return retval; |
|---|
| 285 | | - } |
|---|
| 286 | 259 | retval = rtsx_write_register(chip, SPI_TCTL, EDO_TIMING_MASK, |
|---|
| 287 | 260 | SAMPLE_DELAY_HALF); |
|---|
| 288 | | - if (retval) { |
|---|
| 261 | + if (retval) |
|---|
| 289 | 262 | return retval; |
|---|
| 290 | | - } |
|---|
| 291 | 263 | |
|---|
| 292 | 264 | return STATUS_SUCCESS; |
|---|
| 293 | 265 | } |
|---|
| .. | .. |
|---|
| 306 | 278 | SPI_TRANSFER0_END); |
|---|
| 307 | 279 | |
|---|
| 308 | 280 | retval = rtsx_send_cmd(chip, 0, 100); |
|---|
| 309 | | - if (retval < 0) { |
|---|
| 281 | + if (retval < 0) |
|---|
| 310 | 282 | return STATUS_FAIL; |
|---|
| 311 | | - } |
|---|
| 312 | 283 | |
|---|
| 313 | 284 | return STATUS_SUCCESS; |
|---|
| 314 | 285 | } |
|---|
| .. | .. |
|---|
| 318 | 289 | int retval; |
|---|
| 319 | 290 | |
|---|
| 320 | 291 | retval = spi_init_eeprom(chip); |
|---|
| 321 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 292 | + if (retval != STATUS_SUCCESS) |
|---|
| 322 | 293 | return STATUS_FAIL; |
|---|
| 323 | | - } |
|---|
| 324 | 294 | |
|---|
| 325 | 295 | retval = spi_eeprom_program_enable(chip); |
|---|
| 326 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 296 | + if (retval != STATUS_SUCCESS) |
|---|
| 327 | 297 | return STATUS_FAIL; |
|---|
| 328 | | - } |
|---|
| 329 | 298 | |
|---|
| 330 | 299 | rtsx_init_cmd(chip); |
|---|
| 331 | 300 | |
|---|
| .. | .. |
|---|
| 339 | 308 | SPI_TRANSFER0_END); |
|---|
| 340 | 309 | |
|---|
| 341 | 310 | retval = rtsx_send_cmd(chip, 0, 100); |
|---|
| 342 | | - if (retval < 0) { |
|---|
| 311 | + if (retval < 0) |
|---|
| 343 | 312 | return STATUS_FAIL; |
|---|
| 344 | | - } |
|---|
| 345 | 313 | |
|---|
| 346 | 314 | retval = rtsx_write_register(chip, CARD_GPIO_DIR, 0x01, 0x01); |
|---|
| 347 | | - if (retval) { |
|---|
| 315 | + if (retval) |
|---|
| 348 | 316 | return retval; |
|---|
| 349 | | - } |
|---|
| 350 | 317 | |
|---|
| 351 | 318 | return STATUS_SUCCESS; |
|---|
| 352 | 319 | } |
|---|
| .. | .. |
|---|
| 356 | 323 | int retval; |
|---|
| 357 | 324 | |
|---|
| 358 | 325 | retval = spi_init_eeprom(chip); |
|---|
| 359 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 326 | + if (retval != STATUS_SUCCESS) |
|---|
| 360 | 327 | return STATUS_FAIL; |
|---|
| 361 | | - } |
|---|
| 362 | 328 | |
|---|
| 363 | 329 | retval = spi_eeprom_program_enable(chip); |
|---|
| 364 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 330 | + if (retval != STATUS_SUCCESS) |
|---|
| 365 | 331 | return STATUS_FAIL; |
|---|
| 366 | | - } |
|---|
| 367 | 332 | |
|---|
| 368 | 333 | rtsx_init_cmd(chip); |
|---|
| 369 | 334 | |
|---|
| .. | .. |
|---|
| 379 | 344 | SPI_TRANSFER0_END); |
|---|
| 380 | 345 | |
|---|
| 381 | 346 | retval = rtsx_send_cmd(chip, 0, 100); |
|---|
| 382 | | - if (retval < 0) { |
|---|
| 347 | + if (retval < 0) |
|---|
| 383 | 348 | return STATUS_FAIL; |
|---|
| 384 | | - } |
|---|
| 385 | 349 | |
|---|
| 386 | 350 | retval = rtsx_write_register(chip, CARD_GPIO_DIR, 0x01, 0x01); |
|---|
| 387 | | - if (retval) { |
|---|
| 351 | + if (retval) |
|---|
| 388 | 352 | return retval; |
|---|
| 389 | | - } |
|---|
| 390 | 353 | |
|---|
| 391 | 354 | return STATUS_SUCCESS; |
|---|
| 392 | 355 | } |
|---|
| .. | .. |
|---|
| 397 | 360 | u8 data; |
|---|
| 398 | 361 | |
|---|
| 399 | 362 | retval = spi_init_eeprom(chip); |
|---|
| 400 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 363 | + if (retval != STATUS_SUCCESS) |
|---|
| 401 | 364 | return STATUS_FAIL; |
|---|
| 402 | | - } |
|---|
| 403 | 365 | |
|---|
| 404 | 366 | rtsx_init_cmd(chip); |
|---|
| 405 | 367 | |
|---|
| .. | .. |
|---|
| 416 | 378 | SPI_TRANSFER0_END); |
|---|
| 417 | 379 | |
|---|
| 418 | 380 | retval = rtsx_send_cmd(chip, 0, 100); |
|---|
| 419 | | - if (retval < 0) { |
|---|
| 381 | + if (retval < 0) |
|---|
| 420 | 382 | return STATUS_FAIL; |
|---|
| 421 | | - } |
|---|
| 422 | 383 | |
|---|
| 423 | 384 | wait_timeout(5); |
|---|
| 424 | 385 | retval = rtsx_read_register(chip, SPI_DATA, &data); |
|---|
| 425 | | - if (retval) { |
|---|
| 386 | + if (retval) |
|---|
| 426 | 387 | return retval; |
|---|
| 427 | | - } |
|---|
| 428 | 388 | |
|---|
| 429 | 389 | if (val) |
|---|
| 430 | 390 | *val = data; |
|---|
| 431 | 391 | |
|---|
| 432 | 392 | retval = rtsx_write_register(chip, CARD_GPIO_DIR, 0x01, 0x01); |
|---|
| 433 | | - if (retval) { |
|---|
| 393 | + if (retval) |
|---|
| 434 | 394 | return retval; |
|---|
| 435 | | - } |
|---|
| 436 | 395 | |
|---|
| 437 | 396 | return STATUS_SUCCESS; |
|---|
| 438 | 397 | } |
|---|
| .. | .. |
|---|
| 442 | 401 | int retval; |
|---|
| 443 | 402 | |
|---|
| 444 | 403 | retval = spi_init_eeprom(chip); |
|---|
| 445 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 404 | + if (retval != STATUS_SUCCESS) |
|---|
| 446 | 405 | return STATUS_FAIL; |
|---|
| 447 | | - } |
|---|
| 448 | 406 | |
|---|
| 449 | 407 | retval = spi_eeprom_program_enable(chip); |
|---|
| 450 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 408 | + if (retval != STATUS_SUCCESS) |
|---|
| 451 | 409 | return STATUS_FAIL; |
|---|
| 452 | | - } |
|---|
| 453 | 410 | |
|---|
| 454 | 411 | rtsx_init_cmd(chip); |
|---|
| 455 | 412 | |
|---|
| .. | .. |
|---|
| 466 | 423 | SPI_TRANSFER0_END); |
|---|
| 467 | 424 | |
|---|
| 468 | 425 | retval = rtsx_send_cmd(chip, 0, 100); |
|---|
| 469 | | - if (retval < 0) { |
|---|
| 426 | + if (retval < 0) |
|---|
| 470 | 427 | return STATUS_FAIL; |
|---|
| 471 | | - } |
|---|
| 472 | 428 | |
|---|
| 473 | 429 | retval = rtsx_write_register(chip, CARD_GPIO_DIR, 0x01, 0x01); |
|---|
| 474 | | - if (retval) { |
|---|
| 430 | + if (retval) |
|---|
| 475 | 431 | return retval; |
|---|
| 476 | | - } |
|---|
| 477 | 432 | |
|---|
| 478 | 433 | return STATUS_SUCCESS; |
|---|
| 479 | 434 | } |
|---|
| .. | .. |
|---|
| 577 | 532 | |
|---|
| 578 | 533 | if (len) { |
|---|
| 579 | 534 | buf = kmalloc(len, GFP_KERNEL); |
|---|
| 580 | | - if (!buf) { |
|---|
| 535 | + if (!buf) |
|---|
| 581 | 536 | return STATUS_ERROR; |
|---|
| 582 | | - } |
|---|
| 583 | 537 | |
|---|
| 584 | 538 | retval = rtsx_read_ppbuf(chip, buf, len); |
|---|
| 585 | 539 | if (retval != STATUS_SUCCESS) { |
|---|
| .. | .. |
|---|
| 621 | 575 | } |
|---|
| 622 | 576 | |
|---|
| 623 | 577 | buf = kmalloc(SF_PAGE_LEN, GFP_KERNEL); |
|---|
| 624 | | - if (!buf) { |
|---|
| 578 | + if (!buf) |
|---|
| 625 | 579 | return STATUS_ERROR; |
|---|
| 626 | | - } |
|---|
| 627 | 580 | |
|---|
| 628 | 581 | while (len) { |
|---|
| 629 | 582 | u16 pagelen = SF_PAGE_LEN - (u8)addr; |
|---|
| .. | .. |
|---|
| 716 | 669 | |
|---|
| 717 | 670 | if (program_mode == BYTE_PROGRAM) { |
|---|
| 718 | 671 | buf = kmalloc(4, GFP_KERNEL); |
|---|
| 719 | | - if (!buf) { |
|---|
| 672 | + if (!buf) |
|---|
| 720 | 673 | return STATUS_ERROR; |
|---|
| 721 | | - } |
|---|
| 722 | 674 | |
|---|
| 723 | 675 | while (len) { |
|---|
| 724 | 676 | retval = sf_enable_write(chip, SPI_WREN); |
|---|
| .. | .. |
|---|
| 762 | 714 | int first_byte = 1; |
|---|
| 763 | 715 | |
|---|
| 764 | 716 | retval = sf_enable_write(chip, SPI_WREN); |
|---|
| 765 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 717 | + if (retval != STATUS_SUCCESS) |
|---|
| 766 | 718 | return STATUS_FAIL; |
|---|
| 767 | | - } |
|---|
| 768 | 719 | |
|---|
| 769 | 720 | buf = kmalloc(4, GFP_KERNEL); |
|---|
| 770 | | - if (!buf) { |
|---|
| 721 | + if (!buf) |
|---|
| 771 | 722 | return STATUS_ERROR; |
|---|
| 772 | | - } |
|---|
| 773 | 723 | |
|---|
| 774 | 724 | while (len) { |
|---|
| 775 | 725 | rtsx_stor_access_xfer_buf(buf, 1, srb, &index, &offset, |
|---|
| .. | .. |
|---|
| 808 | 758 | kfree(buf); |
|---|
| 809 | 759 | |
|---|
| 810 | 760 | retval = sf_disable_write(chip, SPI_WRDI); |
|---|
| 811 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 761 | + if (retval != STATUS_SUCCESS) |
|---|
| 812 | 762 | return STATUS_FAIL; |
|---|
| 813 | | - } |
|---|
| 814 | 763 | |
|---|
| 815 | 764 | retval = sf_polling_status(chip, 100); |
|---|
| 816 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 765 | + if (retval != STATUS_SUCCESS) |
|---|
| 817 | 766 | return STATUS_FAIL; |
|---|
| 818 | | - } |
|---|
| 819 | 767 | } else if (program_mode == PAGE_PROGRAM) { |
|---|
| 820 | 768 | buf = kmalloc(SF_PAGE_LEN, GFP_KERNEL); |
|---|
| 821 | | - if (!buf) { |
|---|
| 769 | + if (!buf) |
|---|
| 822 | 770 | return STATUS_NOMEM; |
|---|
| 823 | | - } |
|---|
| 824 | 771 | |
|---|
| 825 | 772 | while (len) { |
|---|
| 826 | 773 | u16 pagelen = SF_PAGE_LEN - (u8)addr; |
|---|
| .. | .. |
|---|
| 893 | 840 | |
|---|
| 894 | 841 | if (erase_mode == PAGE_ERASE) { |
|---|
| 895 | 842 | retval = sf_enable_write(chip, SPI_WREN); |
|---|
| 896 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 843 | + if (retval != STATUS_SUCCESS) |
|---|
| 897 | 844 | return STATUS_FAIL; |
|---|
| 898 | | - } |
|---|
| 899 | 845 | |
|---|
| 900 | 846 | retval = sf_erase(chip, ins, 1, addr); |
|---|
| 901 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 847 | + if (retval != STATUS_SUCCESS) |
|---|
| 902 | 848 | return STATUS_FAIL; |
|---|
| 903 | | - } |
|---|
| 904 | 849 | } else if (erase_mode == CHIP_ERASE) { |
|---|
| 905 | 850 | retval = sf_enable_write(chip, SPI_WREN); |
|---|
| 906 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 851 | + if (retval != STATUS_SUCCESS) |
|---|
| 907 | 852 | return STATUS_FAIL; |
|---|
| 908 | | - } |
|---|
| 909 | 853 | |
|---|
| 910 | 854 | retval = sf_erase(chip, ins, 0, 0); |
|---|
| 911 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 855 | + if (retval != STATUS_SUCCESS) |
|---|
| 912 | 856 | return STATUS_FAIL; |
|---|
| 913 | | - } |
|---|
| 914 | 857 | } else { |
|---|
| 915 | 858 | spi_set_err_code(chip, SPI_INVALID_COMMAND); |
|---|
| 916 | 859 | return STATUS_FAIL; |
|---|
| .. | .. |
|---|
| 935 | 878 | } |
|---|
| 936 | 879 | |
|---|
| 937 | 880 | retval = sf_enable_write(chip, ewsr); |
|---|
| 938 | | - if (retval != STATUS_SUCCESS) { |
|---|
| 881 | + if (retval != STATUS_SUCCESS) |
|---|
| 939 | 882 | return STATUS_FAIL; |
|---|
| 940 | | - } |
|---|
| 941 | 883 | |
|---|
| 942 | 884 | rtsx_init_cmd(chip); |
|---|
| 943 | 885 | |
|---|