add new system file

hc

2024-02-20 102a0743326a03cd1a1202ceda21e175b7d3575c

 kernel/drivers/staging/rts5208/spi.c
..
..
@@ -1,19 +1,8 @@
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,14 +30,12 @@
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,42 +47,35 @@
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,47 +227,39 @@
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,9 +278,8 @@
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,14 +289,12 @@
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,14 +308,12 @@
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,14 +323,12 @@
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,14 +344,12 @@
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,9 +360,8 @@
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,23 +378,20 @@
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,14 +401,12 @@
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,14 +423,12 @@
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,9 +532,8 @@
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,9 +575,8 @@
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,9 +669,8 @@
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,14 +714,12 @@
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,19 +758,16 @@
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,24 +840,20 @@
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,9 +878,8 @@
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