diff options
author | patacongo <patacongo@7fd9a85b-ad96-42d3-883c-3090e2eb8679> | 2012-01-23 17:19:43 +0000 |
---|---|---|
committer | patacongo <patacongo@7fd9a85b-ad96-42d3-883c-3090e2eb8679> | 2012-01-23 17:19:43 +0000 |
commit | 3ea4c058430978370397fc9750c39bcbb9f61471 (patch) | |
tree | e587d534cd4a8bad9b9e46c795e41b79eafc54a1 /nuttx/drivers | |
parent | 8a4e17b86545b63e2cb3f77639dc256c1276f34a (diff) | |
download | px4-firmware-3ea4c058430978370397fc9750c39bcbb9f61471.tar.gz px4-firmware-3ea4c058430978370397fc9750c39bcbb9f61471.tar.bz2 px4-firmware-3ea4c058430978370397fc9750c39bcbb9f61471.zip |
Completes first (untested) cut at MAX1704x battery driver
git-svn-id: https://nuttx.svn.sourceforge.net/svnroot/nuttx/trunk@4324 7fd9a85b-ad96-42d3-883c-3090e2eb8679
Diffstat (limited to 'nuttx/drivers')
-rw-r--r-- | nuttx/drivers/power/Make.defs | 3 | ||||
-rw-r--r-- | nuttx/drivers/power/battery.c | 16 | ||||
-rw-r--r-- | nuttx/drivers/power/max1704x.c | 367 |
3 files changed, 349 insertions, 37 deletions
diff --git a/nuttx/drivers/power/Make.defs b/nuttx/drivers/power/Make.defs index 261e7525c..45c6aebc3 100644 --- a/nuttx/drivers/power/Make.defs +++ b/nuttx/drivers/power/Make.defs @@ -81,5 +81,4 @@ endif DEPPATH += $(POWER_DEPPATH) VPATH += $(POWER_VPATH) -CFLAGS += $(POWER_CFLAGS); - +CFLAGS += $(POWER_CFLAGS) diff --git a/nuttx/drivers/power/battery.c b/nuttx/drivers/power/battery.c index a0d07956a..ce9397408 100644 --- a/nuttx/drivers/power/battery.c +++ b/nuttx/drivers/power/battery.c @@ -170,8 +170,7 @@ static int bat_ioctl(FAR struct file *filep, int cmd, unsigned long arg) FAR int *ptr = (FAR int *)((uintptr_t)arg)); if (ptr) { - *ptr = dev->ops->state(dev); - ret = OK; + ret = dev->ops->state(dev, ptr); } } break; @@ -180,29 +179,26 @@ static int bat_ioctl(FAR struct file *filep, int cmd, unsigned long arg) FAR bool *ptr = (FAR bool *)((uintptr_t)arg)); if (ptr) { - *ptr = dev->ops->online(dev); - ret = OK; + ret = dev->ops->online(dev, ptr); } break; case BATIOC_VOLTAGE: { - FAR int *ptr = (FAR int *)((uintptr_t)arg)); + FAR b16_t *ptr = (FAR b16_t *)((uintptr_t)arg)); if (ptr) { - *ptr = dev->ops->voltage(dev); - ret = OK; + ret = dev->ops->voltage(dev, ptr); } } break; case BATIOC_CAPACITY: { - FAR int *ptr = (FAR int *)((uintptr_t)arg)); + FAR b16_t *ptr = (FAR b16_t *)((uintptr_t)arg)); if (ptr) { - *ptr = dev->ops->capacity(dev); - ret = OK; + ret = dev->ops->capacity(dev, ptr); } } break; diff --git a/nuttx/drivers/power/max1704x.c b/nuttx/drivers/power/max1704x.c index f8a09aec7..58f48aaa3 100644 --- a/nuttx/drivers/power/max1704x.c +++ b/nuttx/drivers/power/max1704x.c @@ -34,6 +34,12 @@ * ****************************************************************************/ +/* "The MAX17040/MAX17041 are ultra-compact, low-cost, host-side fuel-gauge + * systems for lithium-ion (Li+) batteries in handheld and portable equipment. + * The MAX17040 is configured to operate with a single lithium cell and the + * MAX17041 is configured for a dual-cell 2S pack. + */ + /**************************************************************************** * Included Files ****************************************************************************/ @@ -57,6 +63,89 @@ /**************************************************************************** * Pre-processor Definitions ****************************************************************************/ +/* MAX1704x Register Definitions ********************************************/ +/* "All host interaction with the MAX17040/MAX17041 is handled by writing to + * and reading from register locations. The MAX17040/MAX17041 have six 16-bit + * registers: SOC, VCELL, MODE, VERSION, RCOMP, and COMMAND. Register reads + * and writes are only valid if all 16 bits are transferred..." + */ + +/* "VCELL Register. Battery voltage is measured at the CELL pin input with + * respect to GND over a 0 to 5.00V range for the MAX17040 and 0 to 10.00V + * for the MAX17041 with resolutions of 1.25mV and 2.50mV, respectively..." + */ + +#define MAX1407X_VCELL_ADDR 0x02 /* Bits 4-15: Bits 0-11 of the battery voltage */ + +/* VCELL conversion macros */ + +#define MAX14700_VCELL_CONV 82 /* 0.00125 v * 65536 */ +#define MAX14070_VCELL(v) ((b16_t)(v) * MAX14700_VCELL_CONV) + +#define MAX14701_VCELL_CONV 163 /* 0.0025 v * 65536 */ +#define MAX14071_VCELL(v) ((b16_t)(v) * MAX14701_VCELL_CONV) + +/* "SOC Register. The SOC register is a read-only register that displays the + * state of charge of the cell as calculated by the ModelGauge algorithm. The + * result is displayed as a percentage of the cell’s full capacity... + * + * "...Units of % can be directly determined by observing only the high byte + * of the SOC register. The low byte provides additional resolution in units + * 1/256%. + */ + +#define MAX1407X_SOC_ADDR 0x04 /* Bits 0-15: Full SOC */ + +/* SoC conversion macros */ + +#define MAX1407X_SOC(s) ((b16_t)MAX1407X_SOCB8(s) << 8) +#define MAX17040_SOC_FULL itob16(95) /* We say full if Soc >= 95% */ + +/* "MODE Register.The MODE register allows the host processor to send special + * commands to the IC." + */ + +#define MAX1407X_MODE_ADDR 0x06 /* Bits 0-15: 16-bit MODE */ + +/* Supported modes */ + +#define MAX1407X_MODE_QUICKSTART 0x4000 + +/* "The VERSION register is a read-only register that contains a value + * indicating the production version of the MAX17040/MAX17041." + */ + +#define MAX1407X_VERSION_ADDR 0x08 /* Bits 0-15: 16-bit VERSION */ + +/* "RCOMP Register. RCOMP is a 16-bit value used to compensate the ModelGauge + * algorithm. RCOMP can be adjusted to optimize performance for different + * lithium chemistries or different operating temperatures... The factory- + * default value for RCOMP is 9700h." + */ + +#define MAX1407X_RCOMP_ADDR 0x0c /* Bits 0-15: 16-bit RCOMP */ + +/* "COMMAND Register. The COMMAND register allows the host processor to send + * special commands to the IC..." + */ + +#define MAX1407X_COMMAND_ADDR 0xfe /* Bits 0-7: 16-bit COMMAND */ + +/* Supported copmmands */ + +#define MAX1407X_COMMAND_POR 0x5400 + +/* Debug ********************************************************************/ + +#ifdef CONFIG_DEBUG_MAX1704X +# define batdbg dbg +#else +# ifdef CONFIG_CPP_HAVE_VARARGS +# define batdbg(x...) +# else +# define batdbg (void) +# endif +#endif /**************************************************************************** * Private @@ -78,13 +167,28 @@ struct max1704x_dev_s /**************************************************************************** * Private Function Prototypes ****************************************************************************/ +/* I2C support */ + +static int max1704x_getreg16(FAR struct max1704x_dev_s *priv, uint8_t regaddr) + FAR uint16_t *regval); +static int max1704x_putreg16(FAR struct max1704x_dev_s *priv, uint8_t regaddr, + uint16_t regval); + +static inline int max1704x_getvcell(FAR struct max1704x_dev_s *priv, + b16_t *vcell); +static inline int max1704x_getsoc(FAR struct max1704x_dev_s *priv, + b16_t *soc); +static inline int max1704x_setquikstart(FAR struct max1704x_dev_s *priv); +static inline int max1704x_getversion(FAR struct max1704x_dev_s *priv, + uint16_t *version); +static inline int max1704x_reset(FAR struct max1704x_dev_s *priv); /* Battery driver lower half methods */ -static enum battery_status_e mx1704x_state(struct battery_dev_s *lower); -static bool mx1704x_online(struct battery_dev_s *lower); -static int mx1704x_voltage(struct battery_dev_s *lower); -static int mx1704x_capacity(struct battery_dev_s *lower); +static int max1704x_state(struct battery_dev_s *dev, int *status); +static int max1704x_online(struct battery_dev_s *dev, bool *status); +static int max1704x_voltage(struct battery_dev_s *dev, b16_t *value); +static int max1704x_capacity(struct battery_dev_s *dev, b16_t *value); /**************************************************************************** * Private Data @@ -92,10 +196,10 @@ static int mx1704x_capacity(struct battery_dev_s *lower); static const struct battery_operations_s g_max1704xops = { - mx1704x_state, - mx1704x_online, - mx1704x_voltage, - mx1704x_capacity + max1704x_state, + max1704x_online, + max1704x_voltage, + max1704x_capacity }; /**************************************************************************** @@ -103,59 +207,260 @@ static const struct battery_operations_s g_max1704xops = ****************************************************************************/ /**************************************************************************** - * Name: max1704x_open + * Name: max1704x_getreg16 + * + * Description: + * Read a 16-bit value from a MAX1704x register pair. + * + * START <I2C write address> ACK <Reg address> ACK + * REPEATED-START <I2C read address> ACK Data0 ACK Data1 NO-ACK STOP + * + ****************************************************************************/ + +static int max1704x_getreg16(FAR struct max1704x_dev_s *priv, uint8_t regaddr) + FAR uint16_t *regval) +{ + uint8_t buffer[2]; + int ret; + + /* Write the register address */ + + I2C_SETADDRESS(priv->i2c, priv->addr, 7); + ret = I2C_WRITE(priv->i2c, ®addr, 1); + if (ret < 0) + { + batdbg("I2C_WRITE failed: %d\n", ret); + return ret; + } + + /* Restart and read 16-bits from the register */ + + ret = I2C_READ(priv->i2c, buffer, 2); + if (ret < 0) + { + batdbg("I2C_READ failed: %d\n", ret); + return ret; + } + + /* Return the 16-bit value */ + + return (uint16_t)buffer[0] << 8 | (uint16_t)buffer[1]; + return OK; +} + +/**************************************************************************** + * Name: max1704x_putreg16 + * + * Description: + * Write a 16-bit value to a MAX1704x register pair. + * + * START <I2C write address> ACK <Reg address> ACK Data0 ACK Data1 ACK STOP + * + ****************************************************************************/ + +static int max1704x_putreg16(FAR struct max1704x_dev_s *priv, uint8_t regaddr, + uint16_t regval) +{ + uint8_t buffer[3]; + b8_t regb8; + + batdbg("addr: %02x regval: %08x\n", regaddr, regval); + + /* Set up a 3 byte message to send */ + + buffer[0] = regaddr; + buffer[1] = (uint8_t)(regval >> 8); + buffer[2] = (uint8_t)(regval & 0xff); + + /* Write the register address followed by the data (no RESTART) */ + + I2C_SETADDRESS(priv->i2c, priv->addr, 7); + return I2C_WRITE(priv->i2c, buffer, 3); +} + +/**************************************************************************** + * Name: max1704x_getvcell + * + * Description: + * Read the VCELL register and scale the returned value + * + ****************************************************************************/ + +static inline int max1704x_getvcell(FAR struct max1704x_dev_s *priv, + b16_t *vcell) +{ + uint16_t regval; + int ret; + + ret = max1704x_getreg16(priv, MAX1407X_VCELL_ADDR, ®val); + if (ret == OK) + { + *vcell = MAX14070_VCELL(regval); + } + return ret; +} + +/**************************************************************************** + * Name: max1704x_getsoc + * + * Description: + * Read the SOC register and scale the returned value + * + ****************************************************************************/ + +static inline int max1704x_getsoc(FAR struct max1704x_dev_s *priv, + b16_t *soc) +{ + uint16_t regval; + int ret; + + ret = max1704x_getreg16(priv, MAX1407X_VCELL_ADDR, ®val); + if (ret == OK) + { + *soc = MAX1407X_SOC(regval); + } + return ret; +} + +/**************************************************************************** + * Name: max1704x_setquikstart + * + * Description: + * Set Quickstart mode + * + ****************************************************************************/ + +static inline int max1704x_setquikstart(FAR struct max1704x_dev_s *priv) +{ + return max1704x_putreg16(priv, MAX1407X_MODE_ADDR, MAX1407X_MODE_QUICKSTART); +} + +/**************************************************************************** + * Name: max1704x_getversion + * + * Description: + * Read the SOC register and scale the returned value + * + ****************************************************************************/ + +static inline int max1704x_getversion(FAR struct max1704x_dev_s *priv, + uint16_t *version) +{ + return max1704x_getreg16(priv, MAX1407X_VCELL_ADDR, version); +} + +/**************************************************************************** + * Name: max1704x_setrcomp + * + * Description: + * Set Quickstart mode + * + ****************************************************************************/ + +static inline int max1704x_setrcomp(FAR struct max1704x_dev_s *priv, uint16_t rcomp) +{ + return max1704x_putreg16(priv, MAX1407X_RCOMP_ADDR, rcomp); +} + +/**************************************************************************** + * Name: max1704x_reset + * + * Description: + * Reset the MAX1704x + * + ****************************************************************************/ + +static inline int max1704x_reset(FAR struct max1704x_dev_s *priv) +{ + return max1704x_putreg16(priv, MAX1407X_COMMAND_ADDR, MAX1407X_COMMAND_POR); +} + +/**************************************************************************** + * Name: max1704x_state * * Description: * Return the current battery state * ****************************************************************************/ -static enum battery_status_e state(struct battery_dev_s *lower) +static int max1704x_state(struct battery_dev_s *dev, int *status) { -#warning "Missing logic" - return BATTERY_UNKNOWN; + FAR struct max1704x_dev_s *priv = (FAR struct max1704x_dev_s *)dev; + b16_t soc; + int ret; + + /* Only a few of the possible battery states are supported by this driver: + * + * BATTERY_UNKNOWN - Returned on error conditions + * BATTERY_IDLE - This is what will usually be reported + * BATTERY_FULL - This will be reported if the SoC is greater than 95% + * BATTERY_CHARGING and BATTERY_DISCHARGING - I don't think this hardware + * knows anything about current (charging or dischargin). + */ + + ret = max1704x_getsoc(priv, &soc); + if (ret < 0) + { + *status = BATTERY_UNKNOWN; + return ret; + } + + /* Is the battery fully charged? */ + + if (soc > MAX17040_SOC_FULL) + { + *status = BATTERY_FULL; + } + else + { + *status = BATTERY_IDLE; + } + + return OK; } /**************************************************************************** - * Name: max1704x_open + * Name: max1704x_online * * Description: * Return true if the batter is online * ****************************************************************************/ -static bool online(struct battery_dev_s *lower) +static int max1704x_online(struct battery_dev_s *dev, bool *status); { -#warning "Missing logic" - return false; + /* There is no concept of online/offline in this driver */ + + *status = true + return OK; } /**************************************************************************** - * Name: max1704x_open + * Name: max1704x_voltage * * Description: * Current battery voltage * ****************************************************************************/ -static int voltage(struct battery_dev_s *lower); +static int max1704x_voltage(struct battery_dev_s *dev, b16_t *value); { -#warning "Missing logic" - return 0; + FAR struct max1704x_dev_s *priv = (FAR struct max1704x_dev_s *)dev; + return max1704x_getvcell(priv, value); } /**************************************************************************** - * Name: max1704x_open + * Name: max1704x_capacity * * Description: * Battery capacity * ****************************************************************************/ -static int capacity(struct battery_dev_s *lower); +static int max1704x_capacity(struct battery_dev_s *dev, b16_t *value); { -#warning "Missing logic" - return 0; + FAR struct max1704x_dev_s *priv = (FAR struct max1704x_dev_s *)dev; + return max1704x_getsoc(priv, value); } /**************************************************************************** @@ -191,15 +496,27 @@ FAR struct battery_dev_s *max1704x_initialize(FAR struct i2c_dev_s *i2c, FAR struct max1704x_dev_s *priv; int ret; - /* Initialize theMAX1704x device structure */ + /* Initialize the MAX1704x device structure */ priv = (FAR struct max1704x_dev_s *)kzalloc(sizeof(struct max1704x_dev_s)); if (priv) { + /* Initialize the MAX1704x device structure */ + sem_init(&priv->batsem, 0, 1); priv->ops = &g_max1704xops; priv->i2c = i2c; priv->addr = addr; + + /* Reset the MAX1704x (mostly just to make sure that we can talk to it) */ + + ret = max1704x_reset(priv); + if (ret < 0) + { + batdbg("Failed to reset the MAX1704x: %d\n", ret); + kfree(priv); + return NULL; + } } return (FAR struct battery_dev_s *)priv; } |