|
@@ -14,6 +14,7 @@
|
|
|
*/
|
|
|
|
|
|
#include <common.h>
|
|
|
+#include <dm.h>
|
|
|
#include <i2c.h>
|
|
|
#include <cros_ec.h>
|
|
|
|
|
@@ -23,11 +24,11 @@
|
|
|
#define debug_trace(fmt, b...)
|
|
|
#endif
|
|
|
|
|
|
-int cros_ec_i2c_command(struct cros_ec_dev *dev, uint8_t cmd, int cmd_version,
|
|
|
- const uint8_t *dout, int dout_len,
|
|
|
- uint8_t **dinp, int din_len)
|
|
|
+static int cros_ec_i2c_command(struct udevice *udev, uint8_t cmd,
|
|
|
+ int cmd_version, const uint8_t *dout,
|
|
|
+ int dout_len, uint8_t **dinp, int din_len)
|
|
|
{
|
|
|
- int old_bus = 0;
|
|
|
+ struct cros_ec_dev *dev = udev->uclass_priv;
|
|
|
/* version8, cmd8, arglen8, out8[dout_len], csum8 */
|
|
|
int out_bytes = dout_len + 4;
|
|
|
/* response8, arglen8, in8[din_len], checksum8 */
|
|
@@ -37,8 +38,6 @@ int cros_ec_i2c_command(struct cros_ec_dev *dev, uint8_t cmd, int cmd_version,
|
|
|
uint8_t *in_ptr;
|
|
|
int len, csum, ret;
|
|
|
|
|
|
- old_bus = i2c_get_bus_num();
|
|
|
-
|
|
|
/*
|
|
|
* Sanity-check I/O sizes given transaction overhead in internal
|
|
|
* buffers.
|
|
@@ -86,36 +85,24 @@ int cros_ec_i2c_command(struct cros_ec_dev *dev, uint8_t cmd, int cmd_version,
|
|
|
*ptr++ = (uint8_t)
|
|
|
cros_ec_calc_checksum(dev->dout, dout_len + 3);
|
|
|
|
|
|
- /* Set to the proper i2c bus */
|
|
|
- if (i2c_set_bus_num(dev->bus_num)) {
|
|
|
- debug("%s: Cannot change to I2C bus %d\n", __func__,
|
|
|
- dev->bus_num);
|
|
|
- return -1;
|
|
|
- }
|
|
|
-
|
|
|
/* Send output data */
|
|
|
cros_ec_dump_data("out", -1, dev->dout, out_bytes);
|
|
|
- ret = i2c_write(dev->addr, 0, 0, dev->dout, out_bytes);
|
|
|
+ ret = dm_i2c_write(udev, 0, dev->dout, out_bytes);
|
|
|
if (ret) {
|
|
|
- debug("%s: Cannot complete I2C write to 0x%x\n",
|
|
|
- __func__, dev->addr);
|
|
|
+ debug("%s: Cannot complete I2C write to %s\n", __func__,
|
|
|
+ udev->name);
|
|
|
ret = -1;
|
|
|
}
|
|
|
|
|
|
if (!ret) {
|
|
|
- ret = i2c_read(dev->addr, 0, 0, in_ptr, in_bytes);
|
|
|
+ ret = dm_i2c_read(udev, 0, in_ptr, in_bytes);
|
|
|
if (ret) {
|
|
|
- debug("%s: Cannot complete I2C read from 0x%x\n",
|
|
|
- __func__, dev->addr);
|
|
|
+ debug("%s: Cannot complete I2C read from %s\n",
|
|
|
+ __func__, udev->name);
|
|
|
ret = -1;
|
|
|
}
|
|
|
}
|
|
|
|
|
|
- /* Return to original bus number */
|
|
|
- i2c_set_bus_num(old_bus);
|
|
|
- if (ret)
|
|
|
- return ret;
|
|
|
-
|
|
|
if (*in_ptr != EC_RES_SUCCESS) {
|
|
|
debug("%s: Received bad result code %d\n", __func__, *in_ptr);
|
|
|
return -(int)*in_ptr;
|
|
@@ -142,35 +129,24 @@ int cros_ec_i2c_command(struct cros_ec_dev *dev, uint8_t cmd, int cmd_version,
|
|
|
return din_len;
|
|
|
}
|
|
|
|
|
|
-int cros_ec_i2c_decode_fdt(struct cros_ec_dev *dev, const void *blob)
|
|
|
+static int cros_ec_probe(struct udevice *dev)
|
|
|
{
|
|
|
- /* Decode interface-specific FDT params */
|
|
|
- dev->max_frequency = fdtdec_get_int(blob, dev->node,
|
|
|
- "i2c-max-frequency", 100000);
|
|
|
- dev->bus_num = i2c_get_bus_num_fdt(dev->parent_node);
|
|
|
- if (dev->bus_num == -1) {
|
|
|
- debug("%s: Failed to read bus number\n", __func__);
|
|
|
- return -1;
|
|
|
- }
|
|
|
- dev->addr = fdtdec_get_int(blob, dev->node, "reg", -1);
|
|
|
- if (dev->addr == -1) {
|
|
|
- debug("%s: Failed to read device address\n", __func__);
|
|
|
- return -1;
|
|
|
- }
|
|
|
-
|
|
|
- return 0;
|
|
|
+ return cros_ec_register(dev);
|
|
|
}
|
|
|
|
|
|
-/**
|
|
|
- * Initialize I2C protocol.
|
|
|
- *
|
|
|
- * @param dev CROS_EC device
|
|
|
- * @param blob Device tree blob
|
|
|
- * @return 0 if ok, -1 on error
|
|
|
- */
|
|
|
-int cros_ec_i2c_init(struct cros_ec_dev *dev, const void *blob)
|
|
|
-{
|
|
|
- i2c_init(dev->max_frequency, dev->addr);
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
+static struct dm_cros_ec_ops cros_ec_ops = {
|
|
|
+ .command = cros_ec_i2c_command,
|
|
|
+};
|
|
|
+
|
|
|
+static const struct udevice_id cros_ec_ids[] = {
|
|
|
+ { .compatible = "google,cros-ec" },
|
|
|
+ { }
|
|
|
+};
|
|
|
+
|
|
|
+U_BOOT_DRIVER(cros_ec_i2c) = {
|
|
|
+ .name = "cros_ec",
|
|
|
+ .id = UCLASS_CROS_EC,
|
|
|
+ .of_match = cros_ec_ids,
|
|
|
+ .probe = cros_ec_probe,
|
|
|
+ .ops = &cros_ec_ops,
|
|
|
+};
|