1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2 /* Copyright(c) 2018-2019  Realtek Corporation
3  */
4 
5 #include "main.h"
6 #include "efuse.h"
7 #include "reg.h"
8 #include "debug.h"
9 
10 #define RTW_EFUSE_BANK_WIFI		0x0
11 
12 static void switch_efuse_bank(struct rtw_dev *rtwdev)
13 {
14 	rtw_write32_mask(rtwdev, REG_LDO_EFUSE_CTRL, BIT_MASK_EFUSE_BANK_SEL,
15 			 RTW_EFUSE_BANK_WIFI);
16 }
17 
18 #define invalid_efuse_header(hdr1, hdr2) \
19 	((hdr1) == 0xff || (((hdr1) & 0x1f) == 0xf && (hdr2) == 0xff))
20 #define invalid_efuse_content(word_en, i) \
21 	(((word_en) & BIT(i)) != 0x0)
22 #define get_efuse_blk_idx_2_byte(hdr1, hdr2) \
23 	((((hdr2) & 0xf0) >> 1) | (((hdr1) >> 5) & 0x07))
24 #define get_efuse_blk_idx_1_byte(hdr1) \
25 	(((hdr1) & 0xf0) >> 4)
26 #define block_idx_to_logical_idx(blk_idx, i) \
27 	(((blk_idx) << 3) + ((i) << 1))
28 
29 /* efuse header format
30  *
31  * | 7        5   4    0 | 7        4   3          0 | 15  8  7   0 |
32  *   block[2:0]   0 1111   block[6:3]   word_en[3:0]   byte0  byte1
33  * | header 1 (optional) |          header 2         |    word N    |
34  *
35  * word_en: 4 bits each word. 0 -> write; 1 -> not write
36  * N: 1~4, depends on word_en
37  */
38 static int rtw_dump_logical_efuse_map(struct rtw_dev *rtwdev, u8 *phy_map,
39 				      u8 *log_map)
40 {
41 	u32 physical_size = rtwdev->efuse.physical_size;
42 	u32 protect_size = rtwdev->efuse.protect_size;
43 	u32 logical_size = rtwdev->efuse.logical_size;
44 	u32 phy_idx, log_idx;
45 	u8 hdr1, hdr2;
46 	u8 blk_idx;
47 	u8 word_en;
48 	int i;
49 
50 	for (phy_idx = 0; phy_idx < physical_size - protect_size;) {
51 		hdr1 = phy_map[phy_idx];
52 		hdr2 = phy_map[phy_idx + 1];
53 		if (invalid_efuse_header(hdr1, hdr2))
54 			break;
55 
56 		if ((hdr1 & 0x1f) == 0xf) {
57 			/* 2-byte header format */
58 			blk_idx = get_efuse_blk_idx_2_byte(hdr1, hdr2);
59 			word_en = hdr2 & 0xf;
60 			phy_idx += 2;
61 		} else {
62 			/* 1-byte header format */
63 			blk_idx = get_efuse_blk_idx_1_byte(hdr1);
64 			word_en = hdr1 & 0xf;
65 			phy_idx += 1;
66 		}
67 
68 		for (i = 0; i < 4; i++) {
69 			if (invalid_efuse_content(word_en, i))
70 				continue;
71 
72 			log_idx = block_idx_to_logical_idx(blk_idx, i);
73 			if (phy_idx + 1 > physical_size - protect_size ||
74 			    log_idx + 1 > logical_size)
75 				return -EINVAL;
76 
77 			log_map[log_idx] = phy_map[phy_idx];
78 			log_map[log_idx + 1] = phy_map[phy_idx + 1];
79 			phy_idx += 2;
80 		}
81 	}
82 	return 0;
83 }
84 
85 static int rtw_dump_physical_efuse_map(struct rtw_dev *rtwdev, u8 *map)
86 {
87 	struct rtw_chip_info *chip = rtwdev->chip;
88 	u32 size = rtwdev->efuse.physical_size;
89 	u32 efuse_ctl;
90 	u32 addr;
91 	u32 cnt;
92 
93 	switch_efuse_bank(rtwdev);
94 
95 	/* disable 2.5V LDO */
96 	chip->ops->cfg_ldo25(rtwdev, false);
97 
98 	efuse_ctl = rtw_read32(rtwdev, REG_EFUSE_CTRL);
99 
100 	for (addr = 0; addr < size; addr++) {
101 		efuse_ctl &= ~(BIT_MASK_EF_DATA | BITS_EF_ADDR);
102 		efuse_ctl |= (addr & BIT_MASK_EF_ADDR) << BIT_SHIFT_EF_ADDR;
103 		rtw_write32(rtwdev, REG_EFUSE_CTRL, efuse_ctl & (~BIT_EF_FLAG));
104 
105 		cnt = 1000000;
106 		do {
107 			udelay(1);
108 			efuse_ctl = rtw_read32(rtwdev, REG_EFUSE_CTRL);
109 			if (--cnt == 0)
110 				return -EBUSY;
111 		} while (!(efuse_ctl & BIT_EF_FLAG));
112 
113 		*(map + addr) = (u8)(efuse_ctl & BIT_MASK_EF_DATA);
114 	}
115 
116 	return 0;
117 }
118 
119 int rtw_parse_efuse_map(struct rtw_dev *rtwdev)
120 {
121 	struct rtw_chip_info *chip = rtwdev->chip;
122 	struct rtw_efuse *efuse = &rtwdev->efuse;
123 	u32 phy_size = efuse->physical_size;
124 	u32 log_size = efuse->logical_size;
125 	u8 *phy_map = NULL;
126 	u8 *log_map = NULL;
127 	int ret = 0;
128 
129 	phy_map = kmalloc(phy_size, GFP_KERNEL);
130 	log_map = kmalloc(log_size, GFP_KERNEL);
131 	if (!phy_map || !log_map) {
132 		ret = -ENOMEM;
133 		goto out_free;
134 	}
135 
136 	ret = rtw_dump_physical_efuse_map(rtwdev, phy_map);
137 	if (ret) {
138 		rtw_err(rtwdev, "failed to dump efuse physical map\n");
139 		goto out_free;
140 	}
141 
142 	memset(log_map, 0xff, log_size);
143 	ret = rtw_dump_logical_efuse_map(rtwdev, phy_map, log_map);
144 	if (ret) {
145 		rtw_err(rtwdev, "failed to dump efuse logical map\n");
146 		goto out_free;
147 	}
148 
149 	ret = chip->ops->read_efuse(rtwdev, log_map);
150 	if (ret) {
151 		rtw_err(rtwdev, "failed to read efuse map\n");
152 		goto out_free;
153 	}
154 
155 out_free:
156 	kfree(log_map);
157 	kfree(phy_map);
158 
159 	return ret;
160 }
161