1 files changed, 66 insertions, 0 deletions
diff --git a/src/soc/rockchip/rk3288/rk808.c b/src/soc/rockchip/rk3288/rk808.c
new file mode 100644
index 0000000000..0d629ca041
--- /dev/null
+++ b/src/soc/rockchip/rk3288/rk808.c
@@ -0,0 +1,66 @@
+/*
+ * This file is part of the coreboot project.
+ *
+ * Copyright 2014 Rockchip Inc.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; version 2 of the License.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
+ */
+
+#include <assert.h>
+#include <console/console.h>
+#include <device/i2c.h>
+#include <stdint.h>
+#include <stdlib.h>
+#include "rk808.h"
+
+#define RK808_ADDR	0x1b
+
+#define LDO_EN		0x24
+#define LDO_ONSEL(i)	(0x39 + 2 * i)
+#define LDO_SLPSEL(i)	(0x3a + 2 * i)
+
+static void rk808_clrsetbits(uint8_t bus, uint8_t reg, uint8_t clr, uint8_t set)
+{
+	uint8_t value;
+
+	if (i2c_readb(bus, RK808_ADDR, reg, &value) ||
+	    i2c_writeb(bus, RK808_ADDR, reg, (value & ~clr) | set))
+		printk(BIOS_ERR, "ERROR: Cannot set Rk808[%#x]!\n", reg);
+}
+
+void rk808_configure_ldo(uint8_t bus, int ldo, int millivolts)
+{
+	uint8_t vsel;
+
+	switch (ldo) {
+	case 1:
+	case 2:
+	case 4:
+	case 5:
+	case 8:
+		vsel = millivolts / 100 - 18;
+		break;
+	case 3:
+	case 6:
+	case 7:
+		vsel = millivolts / 100 - 8;
+		break;
+	default:
+		die("Unknown LDO index!");
+	}
+	assert(vsel <= 0x10);
+
+	rk808_clrsetbits(bus, LDO_ONSEL(ldo), 0x1f, vsel);
+	rk808_clrsetbits(bus, LDO_EN, 0, 1 << (ldo - 1));
+}