Repurposed sppp_power as battery driver, updated config.

We guess battery charge by measuring current voltage and comparing to a discharge graph.
/sys/class/power_supply/sppp_power show battery data and DCIN changes create device events.

Author: cjenkin2

arch/arm/configs/mx53_efikasb_defconfig

@@ -1,7 +1,7 @@
 #
 # Automatically generated make config: don't edit
 # Linux/arm 2.6.38.3 Kernel Configuration
-# Mon Jul 14 18:42:37 2014
+# Fri Jul 18 15:49:53 2014
 #
 CONFIG_ARM=y
 CONFIG_HAVE_PWM=y
@@ -1268,6 +1268,7 @@ CONFIG_POWER_SUPPLY=y
 # CONFIG_BATTERY_MAX17042 is not set
 # CONFIG_CHARGER_ISP1704 is not set
 # CONFIG_CHARGER_GPIO is not set
+CONFIG_BATTERY_SPPP=y
 CONFIG_HWMON=y
 # CONFIG_HWMON_VID is not set
 # CONFIG_HWMON_DEBUG_CHIP is not set

arch/arm/mach-mx5/Makefile

@@ -17,7 +17,7 @@ obj-$(CONFIG_MACH_MX53_EVK) += board-mx53_evk.o
 obj-$(CONFIG_MACH_MX53_SMD) += board-mx53_smd.o mx53_smd_pmic_da9053.o
 obj-$(CONFIG_MACH_IMX_BLUETOOTH_RFKILL) += imx_bt_rfkill.o
 obj-$(CONFIG_MACH_MX53_LOCO) += board-mx53_loco.o mx53_loco_pmic_da9053.o
-obj-$(CONFIG_MACH_MX53_EFIKASB) += board-mx53_efikasb.o spppdriver.o sppp_power.o
+obj-$(CONFIG_MACH_MX53_EFIKASB) += board-mx53_efikasb.o spppdriver.o
 obj-$(CONFIG_MACH_MX53_ARD) += board-mx53_ard.o
 obj-$(CONFIG_MACH_EUKREA_CPUIMX51) += board-cpuimx51.o
 obj-$(CONFIG_MACH_EUKREA_MBIMX51_BASEBOARD) += eukrea_mbimx51-baseboard.o

arch/arm/mach-mx5/board-mx53_efikasb.c

@@ -324,6 +324,10 @@ struct platform_device mxc_nandv2_mtd_device = {
 	.num_resources = ARRAY_SIZE(mxc_nand_resources),
 };
 
+struct platform_device mxc_battery = {
+	.name = "sppp_power",
+	.id = -1,
+};
 
 static void mx53_efikasb_usbh1_vbus(bool on)
 {
@@ -530,6 +534,9 @@ static void __init mx53_efikasb_board_init(void)
 	/* NAND */
 	mxc_register_device(&mxc_nandv2_mtd_device, &efikasb_nand_data);
 
+	/* Battery */
+	mxc_register_device(&mxc_battery, NULL);
+
 	/*GPU*/
 	if (mx53_revision() >= IMX_CHIP_REVISION_2_0)
 		gpu_data.z160_revision = 1;

arch/arm/mach-mx5/sppp_power.c

@@ -47,7 +47,7 @@ struct sppp_device {
 	struct clk *clk;
 };
 
-/* Array od SPPP clients */
+/* Array of SPPP clients */
 static struct sppp_client *array_of_clients[MAX_CLIENTS] = {NULL};
 
 /* baseint contains the address as a 32 bit integer */
@@ -58,11 +58,48 @@ static struct sppp_device sppp __initdata;
 
 /* Receive structure */
 static sppp_rx_t sppp_rx_g;
+static uint32_t sppp_status_lstn_ids = 0;
+
+/*
+ * Private SPPP client functions
+ */
+static inline int sppp_client_is_registered(struct sppp_client *client)
+{
+	return (client != NULL)           &&
+	       (client->id < MAX_CLIENTS) &&
+	       (array_of_clients[client->id] != NULL);
+}
+
+static inline void sppp_client_mark_lstn(struct sppp_client *client)
+{
+	sppp_status_lstn_ids |= (1 << client->id);
+}
+
+static inline int sppp_client_is_lstn(struct sppp_client *client)
+{
+	return (sppp_status_lstn_ids & (1 << client->id)) != 0;
+}
+
+static inline void sppp_clr_lstn(void)
+{
+	sppp_status_lstn_ids = 0;
+}
+
+/*
+ * Public SPPP client API
+ */
+void sppp_client_status_listen(struct sppp_client *client)
+{
+	if (sppp_client_is_registered(client))
+	        sppp_client_mark_lstn(client);
+	else
+		printk(KERN_ERR "Unrecognized / invalid client!");
+}
 
 /* Registers an SPPP client with the driver */
 void sppp_client_register(struct sppp_client *client)
 {
-	if (client->id <= MAX_CLIENTS)
+	if (client->id < MAX_CLIENTS)
 		array_of_clients[client->id] = client;
 	else
 		printk(KERN_ERR "Wrong client id\n");
@@ -72,13 +109,28 @@ EXPORT_SYMBOL(sppp_client_register);
 /* Removes an SPPP client from the driver */
 void sppp_client_remove(struct sppp_client *client)
 {
-	if (client->id <= MAX_CLIENTS)
+	if (sppp_client_is_registered(client))
 		array_of_clients[client->id] = NULL;
 	else
 		printk(KERN_ERR "Wrong client id\n");
 }
 EXPORT_SYMBOL(sppp_client_remove);
 
+static void send_status(void)
+{
+	int i;
+	struct sppp_client *client;
+
+	for (i = 0; i < MAX_CLIENTS; ++i) {
+		client = array_of_clients[i];
+		if (sppp_client_is_registered(client) &&
+		    sppp_client_is_lstn(client))
+			client->decode(&sppp_rx_g);
+	}
+
+	sppp_clr_lstn();
+}
+
 /* Process, identify and decode packet after full encapulated packet received */
 static int decode(void)
 {
@@ -135,6 +187,16 @@ static int decode(void)
 		if (array_of_clients[KEYBOARD] != NULL)
 			array_of_clients[KEYBOARD]->decode(&sppp_rx_g);
 		break;
+	case SPPP_VBAT_ID:
+		if (array_of_clients[POWER] != NULL)
+			array_of_clients[POWER]->decode(&sppp_rx_g);
+		break;
+	case SPPP_STATUS_ID:
+		if (sppp_status_lstn_ids != 0) {
+			send_status();
+		} else
+			printk(KERN_ERR "STM status received, but no listeners!");
+		break;
 
 	/*	case SPPP_RTC_ID:
 			if (array_of_clients[RTC] != NULL)
@@ -352,6 +414,26 @@ void _sppp_write(sppp_tx_t *sppp_tx, uint8_t data)
 	serial_putc(data);
 }
 
+void sppp_client_send_start(struct sppp_client *client,
+	sppp_tx_t *sppp_tx, uint8_t pkg_id)
+{
+	/* TOOD implement */
+	return;
+}
+
+void sppp_client_send_data(struct sppp_client *client,
+	sppp_tx_t *sppp_tx, uint8_t data)
+{
+	/* TOOD implement */
+	return;
+}
+void sppp_client_send_stop(struct sppp_client *client,
+	sppp_tx_t *sppp_tx)
+{
+	/* TOOD implement */
+	return;
+}
+
 /* Send Start */
 void sppp_start(sppp_tx_t *sppp_tx, uint8_t pkg_id)
 {

arch/arm/mach-mx5/spppdriver.c

@@ -333,7 +333,7 @@ static void kbd_add_col(int col, int key)
  * full scan of the key matix. The keyboard ONLY reports the key deltas
  * between two consecutive scans.
  */
-static void kbd_decode(sppp_rx_t *packet)
+static void kbd_decode(const sppp_rx_t *packet)
 {
 	unsigned char *keys = packet->input;
 	int keyc = packet->pos;
@@ -416,4 +416,4 @@ module_exit(sppp_kbd_exit);
 
 MODULE_LICENSE("GPL");
 MODULE_DESCRIPTION("SPPP keyboard client");
-MODULE_AUTHOR("Johan Dams <jdmm@genesi-usa.com>");
+MODULE_AUTHOR("Johan Dams <jdmm@genesi-usa.com>");

drivers/input/keyboard/sppp_keyboard.c

@@ -37,7 +37,7 @@ static struct sppp_client sppp_trackpad_client;
  * have the same sequence number. We use this to correctly identify the message
  * start and ending of a multibyte message (streaming data from pointing device)
  */
-static void trackpad_decode(sppp_rx_t *packet)
+static void trackpad_decode(const sppp_rx_t *packet)
 {
 	static uint8_t ps2_byte[3];
 	static uint8_t ps2_seq;

drivers/input/mouse/sppp_trackpad.c

@@ -212,4 +212,10 @@ config BATTERY_DA9052
 	  Say Y here to enable support for batteries charger integrated into
 	  DA9052 PMIC.
 
+config BATTERY_SPPP
+	tristate "Efika MX53 SB Battery"
+	depends on MACH_MX53_EFIKASB
+	help
+	  Say Y here to enable support for the Efika MX53 SPPP battery
+
 endif # POWER_SUPPLY

drivers/power/Kconfig

@@ -35,3 +35,4 @@ obj-$(CONFIG_CHARGER_ISP1704)	+= isp1704_charger.o
 obj-$(CONFIG_CHARGER_TWL4030)	+= twl4030_charger.o
 obj-$(CONFIG_CHARGER_GPIO)	+= gpio-charger.o
 obj-$(CONFIG_BATTERY_DA9052)	+= da9052-battery.o
+obj-$(CONFIG_BATTERY_SPPP)	+= sppp_power.o