Test/board-support/u-boot-2017.01+gitAUTOINC+340fb36f04-g340fb36f04/drivers/i2c/cros_ec_ldo.c

/*
 * Copyright (c) 2015 Google, Inc
 * Written by Simon Glass <sjg@chromium.org>
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include <common.h>
#include <dm.h>
#include <cros_ec.h>
#include <errno.h>
#include <i2c.h>
#include <power/tps65090.h>

static int cros_ec_ldo_set_bus_speed(struct udevice *dev, unsigned int speed)
{
	return 0;
}

static int cros_ec_ldo_xfer(struct udevice *dev, struct i2c_msg *msg,
			    int nmsgs)
{
	bool is_read = nmsgs > 1;
	int fet_id, ret;

	/*
	 * Look for reads and writes of the LDO registers. In either case the
	 * first message is a write with the register number as the first byte.
	 */
	if (!nmsgs || !msg->len || (msg->flags & I2C_M_RD)) {
		debug("%s: Invalid message\n", __func__);
		goto err;
	}

	fet_id = msg->buf[0] - REG_FET_BASE;
	if (fet_id < 1 || fet_id > MAX_FET_NUM) {
		debug("%s: Invalid FET %d\n", __func__, fet_id);
		goto err;
	}

	if (is_read) {
		uint8_t state;

		ret = cros_ec_get_ldo(dev->parent, fet_id, &state);
		if (!ret)
			msg[1].buf[0] = state ?
				FET_CTRL_ENFET | FET_CTRL_PGFET : 0;
	} else {
		bool on = msg->buf[1] & FET_CTRL_ENFET;

		ret = cros_ec_set_ldo(dev->parent, fet_id, on);
	}

	return ret;

err:
	/* Indicate that the message is unimplemented */
	return -ENOSYS;
}

static const struct dm_i2c_ops cros_ec_i2c_ops = {
	.xfer		= cros_ec_ldo_xfer,
	.set_bus_speed	= cros_ec_ldo_set_bus_speed,
};

static const struct udevice_id cros_ec_i2c_ids[] = {
	{ .compatible = "google,cros-ec-ldo-tunnel" },
	{ }
};

U_BOOT_DRIVER(cros_ec_ldo) = {
	.name	= "cros_ec_ldo_tunnel",
	.id	= UCLASS_I2C,
	.of_match = cros_ec_i2c_ids,
	.ops	= &cros_ec_i2c_ops,
};