+#define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0]))
+
+static int separate_entries(char *buf, char *entries[], int max_entries)
+{
+ int i = 0;
+
+ entries[i] = buf;
+ i++;
+
+ while (*buf && i< max_entries) {
+ if (*buf != ';') {
+ buf++;
+ continue;
+ }
+
+ *buf = 0;
+ buf++;
+ entries[i] = buf;
+ i++;
+ }
+
+ return i;
+}
+
+static void init_data(struct charger_data *data)
+{
+ int i;
+
+ bzero(data, sizeof(*data));
+ for (i = 0; i < MAX_CELLS; i++)
+ data->cell_voltage[i] = NAN;
+
+ data->timestamp = NAN;
+ data->input_voltage = NAN;
+ data->charging_voltage = NAN;
+ data->charging_current = NAN;
+ data->total_charge = NAN;
+ data->int_temp = NAN;
+ data->ext_temp = NAN;
+}
+
+/*
+ * Convert one log line into charger_data structure. Supports at least
+ * iCharger 6 and 10 cell chargers. Others are not tested.
+ *
+ * Returns negative on incorrect data, zero on success
+ */
+static int parse_logline(const char *buf, struct charger_data *data)
+{
+ int i, j, entry_count;
+ int ret = -1;
+ int max_cells;
+ int d;
+ char *str = strdup(buf);
+ char *entries[64];
+
+ entry_count = separate_entries(str, entries, ARRAY_SIZE(entries));
+
+ pr_debug("Entry count: %d\n", entry_count);
+
+ init_data(data);
+
+ if (entries[0][0] != '$') {
+ pr_debug("Discarding malformed data entry\n");
+ goto out;
+ }
+
+ for (i = 0; i < entry_count; i++)
+ pr_debug("Entry %d: data: %s\n", i, entries[i]);
+
+ i = 0;
+ entries[i]++; /* discard the dollar sign */
+ data->channel = atoi(entries[i++]);
+
+ data->state = atoi(entries[i++]);
+
+ /* Timestamp is optional */
+ if (strlen(entries[1]) > 0)
+ data->timestamp = atof(entries[i++]);
+
+ data->input_voltage = atof(entries[i++]) / 1000.0;
+ data->charging_voltage = atof(entries[i++]) / 1000.0;
+ data->charging_current = atof(entries[i++]) / 100.0;
+
+#define ASSIGN_OR_NAN(data, val) \
+ do { \
+ if ((val) == 0) \
+ (data) = NAN; \
+ else \
+ (data) = val; \
+ } while(0);
+
+ max_cells = entry_count - 10;
+ pr_debug("max_cells: %d\n", max_cells);
+
+ for (j = 0; j < max_cells; j++, i++) {
+ d = atoi(entries[i]);
+ ASSIGN_OR_NAN(data->cell_voltage[j], d / 1000.0);
+ }
+
+ d = atoi(entries[i++]);
+ ASSIGN_OR_NAN(data->int_temp, d / 10.0);
+
+ d = atoi(entries[i++]);
+ ASSIGN_OR_NAN(data->ext_temp, d / 10.0);
+
+ data->total_charge = atof(entries[i++]);
+
+ ret = 0;
+out:
+ free(str);
+ return ret;
+}
+
+static void dump_data(struct charger_data *data)
+{
+ int i;
+
+ pr_debug("channel %d\n", data->channel);
+ pr_debug("state %d\n", data->state);
+ pr_debug("timestamp %.1f\n", data->timestamp);
+ pr_debug("input_voltage %.3f\n", data->input_voltage);
+ pr_debug("charging_voltage %.3f\n", data->charging_voltage);
+ pr_debug("charging_current %.3f\n", data->charging_current);
+
+ for (i = 0; i < MAX_CELLS; i++) {
+ if (isnan(data->cell_voltage[i]))
+ continue;
+
+ pr_debug("cell_voltage[%d] %f\n", i,
+ data->cell_voltage[i]);
+ }
+
+ pr_debug("total_charge %.0f\n", data->total_charge);
+ pr_debug("int_temp %.1f\n", data->int_temp);
+ pr_debug("ext_temp %.1f\n", data->ext_temp);
+}
+