1// SPDX-License-Identifier: GPL-2.0+
2/*
3 * Copyright (c) 2020 Toradex
4 */
5
6#include <dm.h>
7#include <i2c_eeprom.h>
8#include <asm/global_data.h>
9#include <linux/errno.h>
10
11DECLARE_GLOBAL_DATA_PTR;
12
13static int get_tdx_eeprom(u32 eeprom_id, struct udevice **devp)
14{
15	int ret = 0;
16	int node;
17	ofnode eeprom;
18	char eeprom_str[16];
19	const char *path;
20
21	if (!gd->fdt_blob) {
22		printf("%s: don't have a valid gd->fdt_blob!\n", __func__);
23		return -EFAULT;
24	}
25
26	node = fdt_path_offset(gd->fdt_blob, "/aliases");
27	if (node < 0)
28		return -ENODEV;
29
30	sprintf(eeprom_str, "eeprom%d", eeprom_id);
31
32	path = fdt_getprop(gd->fdt_blob, node, eeprom_str, NULL);
33	if (!path) {
34		printf("%s: no alias for %s\n", __func__, eeprom_str);
35		return -ENODEV;
36	}
37
38	eeprom = ofnode_path(path);
39	if (!ofnode_valid(eeprom)) {
40		printf("%s: invalid hardware path to EEPROM\n", __func__);
41		return -ENODEV;
42	}
43
44	ret = uclass_get_device_by_ofnode(UCLASS_I2C_EEPROM, eeprom, devp);
45	if (ret) {
46		printf("%s: cannot find EEPROM by node\n", __func__);
47		return ret;
48	}
49
50	return ret;
51}
52
53int read_tdx_eeprom_data(u32 eeprom_id, int offset, u8 *buf,
54			 int size)
55{
56	struct udevice *dev;
57	int ret;
58
59	ret = get_tdx_eeprom(eeprom_id, &dev);
60	if (ret)
61		return ret;
62
63	ret = i2c_eeprom_read(dev, 0x0, buf, size);
64	if (ret) {
65		printf("%s: error reading data from EEPROM id: %d!, ret = %d\n",
66		       __func__, eeprom_id, ret);
67		return ret;
68	}
69
70	return ret;
71}
72
73int write_tdx_eeprom_data(u32 eeprom_id, int offset, u8 *buf,
74			  int size)
75{
76	struct udevice *dev;
77	int ret;
78
79	ret = get_tdx_eeprom(eeprom_id, &dev);
80	if (ret)
81		return ret;
82
83	ret = i2c_eeprom_write(dev, 0x0, buf, size);
84	if (ret) {
85		printf("%s: error writing data to EEPROM id: %d, ret = %d\n",
86		       __func__, eeprom_id, ret);
87		return ret;
88	}
89
90	return ret;
91}
92