xref: /linux/drivers/gpu/drm/amd/amdgpu/smu_v11_0_i2c.c (revision e5a52fd2b8cdb700b3c07b030e050a49ef3156b9)
1 /*
2  * Copyright 2019 Advanced Micro Devices, Inc.
3  *
4  * Permission is hereby granted, free of charge, to any person obtaining a
5  * copy of this software and associated documentation files (the "Software"),
6  * to deal in the Software without restriction, including without limitation
7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8  * and/or sell copies of the Software, and to permit persons to whom the
9  * Software is furnished to do so, subject to the following conditions:
10  *
11  * The above copyright notice and this permission notice shall be included in
12  * all copies or substantial portions of the Software.
13  *
14  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
17  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20  * OTHER DEALINGS IN THE SOFTWARE.
21  *
22  */
23 
24 #include "smuio/smuio_11_0_0_offset.h"
25 #include "smuio/smuio_11_0_0_sh_mask.h"
26 
27 #include "smu_v11_0_i2c.h"
28 #include "amdgpu.h"
29 #include "soc15_common.h"
30 #include <drm/drm_fixed.h>
31 #include <drm/drm_drv.h>
32 #include "amdgpu_amdkfd.h"
33 #include <linux/i2c.h>
34 #include <linux/pci.h>
35 #include "amdgpu_ras.h"
36 
37 /* error codes */
38 #define I2C_OK                0
39 #define I2C_NAK_7B_ADDR_NOACK 1
40 #define I2C_NAK_TXDATA_NOACK  2
41 #define I2C_TIMEOUT           4
42 #define I2C_SW_TIMEOUT        8
43 #define I2C_ABORT             0x10
44 
45 /* I2C transaction flags */
46 #define I2C_NO_STOP	1
47 #define I2C_RESTART	2
48 
49 #define to_amdgpu_device(x) (container_of(x, struct amdgpu_device, pm.smu_i2c))
50 
51 static void smu_v11_0_i2c_set_clock_gating(struct i2c_adapter *control, bool en)
52 {
53 	struct amdgpu_device *adev = to_amdgpu_device(control);
54 	uint32_t reg = RREG32_SOC15(SMUIO, 0, mmSMUIO_PWRMGT);
55 
56 	reg = REG_SET_FIELD(reg, SMUIO_PWRMGT, i2c_clk_gate_en, en ? 1 : 0);
57 	WREG32_SOC15(SMUIO, 0, mmSMUIO_PWRMGT, reg);
58 }
59 
60 
61 static void smu_v11_0_i2c_enable(struct i2c_adapter *control, bool enable)
62 {
63 	struct amdgpu_device *adev = to_amdgpu_device(control);
64 
65 	WREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_ENABLE, enable ? 1 : 0);
66 }
67 
68 static void smu_v11_0_i2c_clear_status(struct i2c_adapter *control)
69 {
70 	struct amdgpu_device *adev = to_amdgpu_device(control);
71 	/* do */
72 	{
73 		RREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_CLR_INTR);
74 
75 	} /* while (reg_CKSVII2C_ic_clr_intr == 0) */
76 }
77 
78 static void smu_v11_0_i2c_configure(struct i2c_adapter *control)
79 {
80 	struct amdgpu_device *adev = to_amdgpu_device(control);
81 	uint32_t reg = 0;
82 
83 	reg = REG_SET_FIELD(reg, CKSVII2C_IC_CON, IC_SLAVE_DISABLE, 1);
84 	reg = REG_SET_FIELD(reg, CKSVII2C_IC_CON, IC_RESTART_EN, 1);
85 	reg = REG_SET_FIELD(reg, CKSVII2C_IC_CON, IC_10BITADDR_MASTER, 0);
86 	reg = REG_SET_FIELD(reg, CKSVII2C_IC_CON, IC_10BITADDR_SLAVE, 0);
87 	/* Standard mode */
88 	reg = REG_SET_FIELD(reg, CKSVII2C_IC_CON, IC_MAX_SPEED_MODE, 2);
89 	reg = REG_SET_FIELD(reg, CKSVII2C_IC_CON, IC_MASTER_MODE, 1);
90 
91 	WREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_CON, reg);
92 }
93 
94 static void smu_v11_0_i2c_set_clock(struct i2c_adapter *control)
95 {
96 	struct amdgpu_device *adev = to_amdgpu_device(control);
97 
98 	/*
99 	 * Standard mode speed, These values are taken from SMUIO MAS,
100 	 * but are different from what is given is
101 	 * Synopsys spec. The values here are based on assumption
102 	 * that refclock is 100MHz
103 	 *
104 	 * Configuration for standard mode; Speed = 100kbps
105 	 * Scale linearly, for now only support standard speed clock
106 	 * This will work only with 100M ref clock
107 	 *
108 	 * TBD:Change the calculation to take into account ref clock values also.
109 	 */
110 
111 	WREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_FS_SPKLEN, 2);
112 	WREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_SS_SCL_HCNT, 120);
113 	WREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_SS_SCL_LCNT, 130);
114 	WREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_SDA_HOLD, 20);
115 }
116 
117 static void smu_v11_0_i2c_set_address(struct i2c_adapter *control, uint8_t address)
118 {
119 	struct amdgpu_device *adev = to_amdgpu_device(control);
120 
121 	/* Convert fromr 8-bit to 7-bit address */
122 	address >>= 1;
123 	WREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_TAR, (address & 0xFF));
124 }
125 
126 static uint32_t smu_v11_0_i2c_poll_tx_status(struct i2c_adapter *control)
127 {
128 	struct amdgpu_device *adev = to_amdgpu_device(control);
129 	uint32_t ret = I2C_OK;
130 	uint32_t reg, reg_c_tx_abrt_source;
131 
132 	/*Check if transmission is completed */
133 	unsigned long  timeout_counter = jiffies + msecs_to_jiffies(20);
134 
135 	do {
136 		if (time_after(jiffies, timeout_counter)) {
137 			ret |= I2C_SW_TIMEOUT;
138 			break;
139 		}
140 
141 		reg = RREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_STATUS);
142 
143 	} while (REG_GET_FIELD(reg, CKSVII2C_IC_STATUS, TFE) == 0);
144 
145 	if (ret != I2C_OK)
146 		return ret;
147 
148 	/* This only checks if NAK is received and transaction got aborted */
149 	reg = RREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_INTR_STAT);
150 
151 	if (REG_GET_FIELD(reg, CKSVII2C_IC_INTR_STAT, R_TX_ABRT) == 1) {
152 		reg_c_tx_abrt_source = RREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_TX_ABRT_SOURCE);
153 		DRM_INFO("TX was terminated, IC_TX_ABRT_SOURCE val is:%x", reg_c_tx_abrt_source);
154 
155 		/* Check for stop due to NACK */
156 		if (REG_GET_FIELD(reg_c_tx_abrt_source,
157 				  CKSVII2C_IC_TX_ABRT_SOURCE,
158 				  ABRT_TXDATA_NOACK) == 1) {
159 
160 			ret |= I2C_NAK_TXDATA_NOACK;
161 
162 		} else if (REG_GET_FIELD(reg_c_tx_abrt_source,
163 					 CKSVII2C_IC_TX_ABRT_SOURCE,
164 					 ABRT_7B_ADDR_NOACK) == 1) {
165 
166 			ret |= I2C_NAK_7B_ADDR_NOACK;
167 		} else {
168 			ret |= I2C_ABORT;
169 		}
170 
171 		smu_v11_0_i2c_clear_status(control);
172 	}
173 
174 	return ret;
175 }
176 
177 static uint32_t smu_v11_0_i2c_poll_rx_status(struct i2c_adapter *control)
178 {
179 	struct amdgpu_device *adev = to_amdgpu_device(control);
180 	uint32_t ret = I2C_OK;
181 	uint32_t reg_ic_status, reg_c_tx_abrt_source;
182 
183 	reg_c_tx_abrt_source = RREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_TX_ABRT_SOURCE);
184 
185 	/* If slave is not present */
186 	if (REG_GET_FIELD(reg_c_tx_abrt_source,
187 			  CKSVII2C_IC_TX_ABRT_SOURCE,
188 			  ABRT_7B_ADDR_NOACK) == 1) {
189 		ret |= I2C_NAK_7B_ADDR_NOACK;
190 
191 		smu_v11_0_i2c_clear_status(control);
192 	} else {  /* wait till some data is there in RXFIFO */
193 		/* Poll for some byte in RXFIFO */
194 		unsigned long  timeout_counter = jiffies + msecs_to_jiffies(20);
195 
196 		do {
197 			if (time_after(jiffies, timeout_counter)) {
198 				ret |= I2C_SW_TIMEOUT;
199 				break;
200 			}
201 
202 			reg_ic_status = RREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_STATUS);
203 
204 		} while (REG_GET_FIELD(reg_ic_status, CKSVII2C_IC_STATUS, RFNE) == 0);
205 	}
206 
207 	return ret;
208 }
209 
210 
211 
212 
213 /**
214  * smu_v11_0_i2c_transmit - Send a block of data over the I2C bus to a slave device.
215  *
216  * @address: The I2C address of the slave device.
217  * @data: The data to transmit over the bus.
218  * @numbytes: The amount of data to transmit.
219  * @i2c_flag: Flags for transmission
220  *
221  * Returns 0 on success or error.
222  */
223 static uint32_t smu_v11_0_i2c_transmit(struct i2c_adapter *control,
224 				  uint8_t address, uint8_t *data,
225 				  uint32_t numbytes, uint32_t i2c_flag)
226 {
227 	struct amdgpu_device *adev = to_amdgpu_device(control);
228 	uint32_t bytes_sent, reg, ret = 0;
229 	unsigned long  timeout_counter;
230 
231 	bytes_sent = 0;
232 
233 	DRM_DEBUG_DRIVER("I2C_Transmit(), address = %x, bytes = %d , data: ",
234 		 (uint16_t)address, numbytes);
235 
236 	if (drm_debug_enabled(DRM_UT_DRIVER)) {
237 		print_hex_dump(KERN_INFO, "data: ", DUMP_PREFIX_NONE,
238 			       16, 1, data, numbytes, false);
239 	}
240 
241 	/* Set the I2C slave address */
242 	smu_v11_0_i2c_set_address(control, address);
243 	/* Enable I2C */
244 	smu_v11_0_i2c_enable(control, true);
245 
246 	/* Clear status bits */
247 	smu_v11_0_i2c_clear_status(control);
248 
249 
250 	timeout_counter = jiffies + msecs_to_jiffies(20);
251 
252 	while (numbytes > 0) {
253 		reg = RREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_STATUS);
254 		if (REG_GET_FIELD(reg, CKSVII2C_IC_STATUS, TFNF)) {
255 			do {
256 				reg = 0;
257 				/*
258 				 * Prepare transaction, no need to set RESTART. I2C engine will send
259 				 * START as soon as it sees data in TXFIFO
260 				 */
261 				if (bytes_sent == 0)
262 					reg = REG_SET_FIELD(reg, CKSVII2C_IC_DATA_CMD, RESTART,
263 							    (i2c_flag & I2C_RESTART) ? 1 : 0);
264 				reg = REG_SET_FIELD(reg, CKSVII2C_IC_DATA_CMD, DAT, data[bytes_sent]);
265 
266 				/* determine if we need to send STOP bit or not */
267 				if (numbytes == 1)
268 					/* Final transaction, so send stop unless I2C_NO_STOP */
269 					reg = REG_SET_FIELD(reg, CKSVII2C_IC_DATA_CMD, STOP,
270 							    (i2c_flag & I2C_NO_STOP) ? 0 : 1);
271 				/* Write */
272 				reg = REG_SET_FIELD(reg, CKSVII2C_IC_DATA_CMD, CMD, 0);
273 				WREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_DATA_CMD, reg);
274 
275 				/* Record that the bytes were transmitted */
276 				bytes_sent++;
277 				numbytes--;
278 
279 				reg = RREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_STATUS);
280 
281 			} while (numbytes &&  REG_GET_FIELD(reg, CKSVII2C_IC_STATUS, TFNF));
282 		}
283 
284 		/*
285 		 * We waited too long for the transmission FIFO to become not-full.
286 		 * Exit the loop with error.
287 		 */
288 		if (time_after(jiffies, timeout_counter)) {
289 			ret |= I2C_SW_TIMEOUT;
290 			goto Err;
291 		}
292 	}
293 
294 	ret = smu_v11_0_i2c_poll_tx_status(control);
295 
296 Err:
297 	/* Any error, no point in proceeding */
298 	if (ret != I2C_OK) {
299 		if (ret & I2C_SW_TIMEOUT)
300 			DRM_ERROR("TIMEOUT ERROR !!!");
301 
302 		if (ret & I2C_NAK_7B_ADDR_NOACK)
303 			DRM_ERROR("Received I2C_NAK_7B_ADDR_NOACK !!!");
304 
305 
306 		if (ret & I2C_NAK_TXDATA_NOACK)
307 			DRM_ERROR("Received I2C_NAK_TXDATA_NOACK !!!");
308 	}
309 
310 	return ret;
311 }
312 
313 
314 /**
315  * smu_v11_0_i2c_receive - Receive a block of data over the I2C bus from a slave device.
316  *
317  * @address: The I2C address of the slave device.
318  * @numbytes: The amount of data to transmit.
319  * @i2c_flag: Flags for transmission
320  *
321  * Returns 0 on success or error.
322  */
323 static uint32_t smu_v11_0_i2c_receive(struct i2c_adapter *control,
324 				 uint8_t address, uint8_t *data,
325 				 uint32_t numbytes, uint8_t i2c_flag)
326 {
327 	struct amdgpu_device *adev = to_amdgpu_device(control);
328 	uint32_t bytes_received, ret = I2C_OK;
329 
330 	bytes_received = 0;
331 
332 	/* Set the I2C slave address */
333 	smu_v11_0_i2c_set_address(control, address);
334 
335 	/* Enable I2C */
336 	smu_v11_0_i2c_enable(control, true);
337 
338 	while (numbytes > 0) {
339 		uint32_t reg = 0;
340 
341 		smu_v11_0_i2c_clear_status(control);
342 
343 
344 		/* Prepare transaction */
345 
346 		/* Each time we disable I2C, so this is not a restart */
347 		if (bytes_received == 0)
348 			reg = REG_SET_FIELD(reg, CKSVII2C_IC_DATA_CMD, RESTART,
349 					    (i2c_flag & I2C_RESTART) ? 1 : 0);
350 
351 		reg = REG_SET_FIELD(reg, CKSVII2C_IC_DATA_CMD, DAT, 0);
352 		/* Read */
353 		reg = REG_SET_FIELD(reg, CKSVII2C_IC_DATA_CMD, CMD, 1);
354 
355 		/* Transmitting last byte */
356 		if (numbytes == 1)
357 			/* Final transaction, so send stop if requested */
358 			reg = REG_SET_FIELD(reg, CKSVII2C_IC_DATA_CMD, STOP,
359 					    (i2c_flag & I2C_NO_STOP) ? 0 : 1);
360 
361 		WREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_DATA_CMD, reg);
362 
363 		ret = smu_v11_0_i2c_poll_rx_status(control);
364 
365 		/* Any error, no point in proceeding */
366 		if (ret != I2C_OK) {
367 			if (ret & I2C_SW_TIMEOUT)
368 				DRM_ERROR("TIMEOUT ERROR !!!");
369 
370 			if (ret & I2C_NAK_7B_ADDR_NOACK)
371 				DRM_ERROR("Received I2C_NAK_7B_ADDR_NOACK !!!");
372 
373 			if (ret & I2C_NAK_TXDATA_NOACK)
374 				DRM_ERROR("Received I2C_NAK_TXDATA_NOACK !!!");
375 
376 			break;
377 		}
378 
379 		reg = RREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_DATA_CMD);
380 		data[bytes_received] = REG_GET_FIELD(reg, CKSVII2C_IC_DATA_CMD, DAT);
381 
382 		/* Record that the bytes were received */
383 		bytes_received++;
384 		numbytes--;
385 	}
386 
387 	DRM_DEBUG_DRIVER("I2C_Receive(), address = %x, bytes = %d, data :",
388 		  (uint16_t)address, bytes_received);
389 
390 	if (drm_debug_enabled(DRM_UT_DRIVER)) {
391 		print_hex_dump(KERN_INFO, "data: ", DUMP_PREFIX_NONE,
392 			       16, 1, data, bytes_received, false);
393 	}
394 
395 	return ret;
396 }
397 
398 static void smu_v11_0_i2c_abort(struct i2c_adapter *control)
399 {
400 	struct amdgpu_device *adev = to_amdgpu_device(control);
401 	uint32_t reg = 0;
402 
403 	/* Enable I2C engine; */
404 	reg = REG_SET_FIELD(reg, CKSVII2C_IC_ENABLE, ENABLE, 1);
405 	WREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_ENABLE, reg);
406 
407 	/* Abort previous transaction */
408 	reg = REG_SET_FIELD(reg, CKSVII2C_IC_ENABLE, ABORT, 1);
409 	WREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_ENABLE, reg);
410 
411 	DRM_DEBUG_DRIVER("I2C_Abort() Done.");
412 }
413 
414 
415 static bool smu_v11_0_i2c_activity_done(struct i2c_adapter *control)
416 {
417 	struct amdgpu_device *adev = to_amdgpu_device(control);
418 
419 	const uint32_t IDLE_TIMEOUT = 1024;
420 	uint32_t timeout_count = 0;
421 	uint32_t reg_ic_enable, reg_ic_enable_status, reg_ic_clr_activity;
422 
423 	reg_ic_enable_status = RREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_ENABLE_STATUS);
424 	reg_ic_enable = RREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_ENABLE);
425 
426 
427 	if ((REG_GET_FIELD(reg_ic_enable, CKSVII2C_IC_ENABLE, ENABLE) == 0) &&
428 	    (REG_GET_FIELD(reg_ic_enable_status, CKSVII2C_IC_ENABLE_STATUS, IC_EN) == 1)) {
429 		/*
430 		 * Nobody is using I2C engine, but engine remains active because
431 		 * someone missed to send STOP
432 		 */
433 		smu_v11_0_i2c_abort(control);
434 	} else if (REG_GET_FIELD(reg_ic_enable, CKSVII2C_IC_ENABLE, ENABLE) == 0) {
435 		/* Nobody is using I2C engine */
436 		return true;
437 	}
438 
439 	/* Keep reading activity bit until it's cleared */
440 	do {
441 		reg_ic_clr_activity = RREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_CLR_ACTIVITY);
442 
443 		if (REG_GET_FIELD(reg_ic_clr_activity,
444 		    CKSVII2C_IC_CLR_ACTIVITY, CLR_ACTIVITY) == 0)
445 			return true;
446 
447 		++timeout_count;
448 
449 	} while (timeout_count < IDLE_TIMEOUT);
450 
451 	return false;
452 }
453 
454 static void smu_v11_0_i2c_init(struct i2c_adapter *control)
455 {
456 	/* Disable clock gating */
457 	smu_v11_0_i2c_set_clock_gating(control, false);
458 
459 	if (!smu_v11_0_i2c_activity_done(control))
460 		DRM_WARN("I2C busy !");
461 
462 	/* Disable I2C */
463 	smu_v11_0_i2c_enable(control, false);
464 
465 	/* Configure I2C to operate as master and in standard mode */
466 	smu_v11_0_i2c_configure(control);
467 
468 	/* Initialize the clock to 50 kHz default */
469 	smu_v11_0_i2c_set_clock(control);
470 
471 }
472 
473 static void smu_v11_0_i2c_fini(struct i2c_adapter *control)
474 {
475 	struct amdgpu_device *adev = to_amdgpu_device(control);
476 	uint32_t reg_ic_enable_status, reg_ic_enable;
477 
478 	smu_v11_0_i2c_enable(control, false);
479 
480 	/* Double check if disabled, else force abort */
481 	reg_ic_enable_status = RREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_ENABLE_STATUS);
482 	reg_ic_enable = RREG32_SOC15(SMUIO, 0, mmCKSVII2C_IC_ENABLE);
483 
484 	if ((REG_GET_FIELD(reg_ic_enable, CKSVII2C_IC_ENABLE, ENABLE) == 0) &&
485 	    (REG_GET_FIELD(reg_ic_enable_status,
486 			   CKSVII2C_IC_ENABLE_STATUS, IC_EN) == 1)) {
487 		/*
488 		 * Nobody is using I2C engine, but engine remains active because
489 		 * someone missed to send STOP
490 		 */
491 		smu_v11_0_i2c_abort(control);
492 	}
493 
494 	/* Restore clock gating */
495 
496 	/*
497 	 * TODO Reenabling clock gating seems to break subsequent SMU operation
498 	 *      on the I2C bus. My guess is that SMU doesn't disable clock gating like
499 	 *      we do here before working with the bus. So for now just don't restore
500 	 *      it but later work with SMU to see if they have this issue and can
501 	 *      update their code appropriately
502 	 */
503 	/* smu_v11_0_i2c_set_clock_gating(control, true); */
504 
505 }
506 
507 static bool smu_v11_0_i2c_bus_lock(struct i2c_adapter *control)
508 {
509 	struct amdgpu_device *adev = to_amdgpu_device(control);
510 
511 	/* Send  PPSMC_MSG_RequestI2CBus */
512 	if (!adev->powerplay.pp_funcs->smu_i2c_bus_access)
513 		goto Fail;
514 
515 
516 	if (!adev->powerplay.pp_funcs->smu_i2c_bus_access(adev->powerplay.pp_handle, true))
517 		return true;
518 
519 Fail:
520 	return false;
521 }
522 
523 static bool smu_v11_0_i2c_bus_unlock(struct i2c_adapter *control)
524 {
525 	struct amdgpu_device *adev = to_amdgpu_device(control);
526 
527 	/* Send  PPSMC_MSG_RequestI2CBus */
528 	if (!adev->powerplay.pp_funcs->smu_i2c_bus_access)
529 		goto Fail;
530 
531 	/* Send  PPSMC_MSG_ReleaseI2CBus */
532 	if (!adev->powerplay.pp_funcs->smu_i2c_bus_access(adev->powerplay.pp_handle,
533 							     false))
534 		return true;
535 
536 Fail:
537 	return false;
538 }
539 
540 /***************************** EEPROM I2C GLUE ****************************/
541 
542 static uint32_t smu_v11_0_i2c_eeprom_read_data(struct i2c_adapter *control,
543 					       uint8_t address,
544 					       uint8_t *data,
545 					       uint32_t numbytes)
546 {
547 	uint32_t  ret = 0;
548 
549 	/* First 2 bytes are dummy write to set EEPROM address */
550 	ret = smu_v11_0_i2c_transmit(control, address, data, 2, I2C_NO_STOP);
551 	if (ret != I2C_OK)
552 		goto Fail;
553 
554 	/* Now read data starting with that address */
555 	ret = smu_v11_0_i2c_receive(control, address, data + 2, numbytes - 2,
556 				    I2C_RESTART);
557 
558 Fail:
559 	if (ret != I2C_OK)
560 		DRM_ERROR("ReadData() - I2C error occurred :%x", ret);
561 
562 	return ret;
563 }
564 
565 static uint32_t smu_v11_0_i2c_eeprom_write_data(struct i2c_adapter *control,
566 						uint8_t address,
567 						uint8_t *data,
568 						uint32_t numbytes)
569 {
570 	uint32_t  ret;
571 
572 	ret = smu_v11_0_i2c_transmit(control, address, data, numbytes, 0);
573 
574 	if (ret != I2C_OK)
575 		DRM_ERROR("WriteI2CData() - I2C error occurred :%x", ret);
576 	else
577 		/*
578 		 * According to EEPROM spec there is a MAX of 10 ms required for
579 		 * EEPROM to flush internal RX buffer after STOP was issued at the
580 		 * end of write transaction. During this time the EEPROM will not be
581 		 * responsive to any more commands - so wait a bit more.
582 		 *
583 		 * TODO Improve to wait for first ACK for slave address after
584 		 * internal write cycle done.
585 		 */
586 		msleep(10);
587 
588 	return ret;
589 
590 }
591 
592 static void lock_bus(struct i2c_adapter *i2c, unsigned int flags)
593 {
594 	struct amdgpu_device *adev = to_amdgpu_device(i2c);
595 	struct amdgpu_ras_eeprom_control *control = &adev->psp.ras.ras->eeprom_control;
596 
597 	if (!smu_v11_0_i2c_bus_lock(i2c)) {
598 		DRM_ERROR("Failed to lock the bus from SMU");
599 		return;
600 	}
601 
602 	control->bus_locked = true;
603 }
604 
605 static int trylock_bus(struct i2c_adapter *i2c, unsigned int flags)
606 {
607 	WARN_ONCE(1, "This operation not supposed to run in atomic context!");
608 	return false;
609 }
610 
611 static void unlock_bus(struct i2c_adapter *i2c, unsigned int flags)
612 {
613 	struct amdgpu_device *adev = to_amdgpu_device(i2c);
614 	struct amdgpu_ras_eeprom_control *control = &adev->psp.ras.ras->eeprom_control;
615 
616 	if (!smu_v11_0_i2c_bus_unlock(i2c)) {
617 		DRM_ERROR("Failed to unlock the bus from SMU");
618 		return;
619 	}
620 
621 	control->bus_locked = false;
622 }
623 
624 static const struct i2c_lock_operations smu_v11_0_i2c_i2c_lock_ops = {
625 	.lock_bus = lock_bus,
626 	.trylock_bus = trylock_bus,
627 	.unlock_bus = unlock_bus,
628 };
629 
630 static int smu_v11_0_i2c_eeprom_i2c_xfer(struct i2c_adapter *i2c_adap,
631 			      struct i2c_msg *msgs, int num)
632 {
633 	int i, ret;
634 	struct amdgpu_device *adev = to_amdgpu_device(i2c_adap);
635 	struct amdgpu_ras_eeprom_control *control = &adev->psp.ras.ras->eeprom_control;
636 
637 	if (!control->bus_locked) {
638 		DRM_ERROR("I2C bus unlocked, stopping transaction!");
639 		return -EIO;
640 	}
641 
642 	smu_v11_0_i2c_init(i2c_adap);
643 
644 	for (i = 0; i < num; i++) {
645 		if (msgs[i].flags & I2C_M_RD)
646 			ret = smu_v11_0_i2c_eeprom_read_data(i2c_adap,
647 							(uint8_t)msgs[i].addr,
648 							msgs[i].buf, msgs[i].len);
649 		else
650 			ret = smu_v11_0_i2c_eeprom_write_data(i2c_adap,
651 							 (uint8_t)msgs[i].addr,
652 							 msgs[i].buf, msgs[i].len);
653 
654 		if (ret != I2C_OK) {
655 			num = -EIO;
656 			break;
657 		}
658 	}
659 
660 	smu_v11_0_i2c_fini(i2c_adap);
661 	return num;
662 }
663 
664 static u32 smu_v11_0_i2c_eeprom_i2c_func(struct i2c_adapter *adap)
665 {
666 	return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
667 }
668 
669 
670 static const struct i2c_algorithm smu_v11_0_i2c_eeprom_i2c_algo = {
671 	.master_xfer = smu_v11_0_i2c_eeprom_i2c_xfer,
672 	.functionality = smu_v11_0_i2c_eeprom_i2c_func,
673 };
674 
675 int smu_v11_0_i2c_eeprom_control_init(struct i2c_adapter *control)
676 {
677 	struct amdgpu_device *adev = to_amdgpu_device(control);
678 	int res;
679 
680 	control->owner = THIS_MODULE;
681 	control->class = I2C_CLASS_SPD;
682 	control->dev.parent = &adev->pdev->dev;
683 	control->algo = &smu_v11_0_i2c_eeprom_i2c_algo;
684 	snprintf(control->name, sizeof(control->name), "AMDGPU EEPROM");
685 	control->lock_ops = &smu_v11_0_i2c_i2c_lock_ops;
686 
687 	res = i2c_add_adapter(control);
688 	if (res)
689 		DRM_ERROR("Failed to register hw i2c, err: %d\n", res);
690 
691 	return res;
692 }
693 
694 void smu_v11_0_i2c_eeprom_control_fini(struct i2c_adapter *control)
695 {
696 	i2c_del_adapter(control);
697 }
698 
699 /*
700  * Keep this for future unit test if bugs arise
701  */
702 #if 0
703 #define I2C_TARGET_ADDR 0xA0
704 
705 bool smu_v11_0_i2c_test_bus(struct i2c_adapter *control)
706 {
707 
708 	uint32_t ret = I2C_OK;
709 	uint8_t data[6] = {0xf, 0, 0xde, 0xad, 0xbe, 0xef};
710 
711 
712 	DRM_INFO("Begin");
713 
714 	if (!smu_v11_0_i2c_bus_lock(control)) {
715 		DRM_ERROR("Failed to lock the bus!.");
716 		return false;
717 	}
718 
719 	smu_v11_0_i2c_init(control);
720 
721 	/* Write 0xde to address 0x0000 on the EEPROM */
722 	ret = smu_v11_0_i2c_eeprom_write_data(control, I2C_TARGET_ADDR, data, 6);
723 
724 	ret = smu_v11_0_i2c_eeprom_read_data(control, I2C_TARGET_ADDR, data, 6);
725 
726 	smu_v11_0_i2c_fini(control);
727 
728 	smu_v11_0_i2c_bus_unlock(control);
729 
730 
731 	DRM_INFO("End");
732 	return true;
733 }
734 #endif
735