nuttx/drivers/power/battery_monitor.c

568 lines
14 KiB
C
Raw Normal View History

/****************************************************************************
* drivers/power/battery_monitor.c
*
* Licensed to the Apache Software Foundation (ASF) under one or more
* contributor license agreements. See the NOTICE file distributed with
* this work for additional information regarding copyright ownership. The
* ASF licenses this file to you under the Apache License, Version 2.0 (the
* "License"); you may not use this file except in compliance with the
* License. You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
* License for the specific language governing permissions and limitations
* under the License.
*
****************************************************************************/
/* Upper-half, character driver for battery manager & monitor ICs. */
/****************************************************************************
* Included Files
****************************************************************************/
#include <nuttx/config.h>
#include <stdbool.h>
#include <errno.h>
#include <string.h>
#include <debug.h>
#include <poll.h>
#include <fcntl.h>
#include <nuttx/semaphore.h>
#include <nuttx/fs/fs.h>
#include <nuttx/kmalloc.h>
#include <nuttx/power/battery_monitor.h>
#include <nuttx/power/battery_ioctl.h>
/* This driver requires:
*
* CONFIG_BATTERY_MONITOR - Upper half battery driver support
*/
#if defined(CONFIG_BATTERY_MONITOR)
/****************************************************************************
* Pre-processor Definitions
****************************************************************************/
/****************************************************************************
* Private type
****************************************************************************/
struct battery_monitor_priv_s
{
struct list_node node;
sem_t lock;
sem_t wait;
uint32_t mask;
FAR struct pollfd *fds;
};
/****************************************************************************
* Private Function Prototypes
****************************************************************************/
/* Character driver methods */
static int bat_monitor_open(FAR struct file *filep);
static int bat_monitor_close(FAR struct file *filep);
static ssize_t bat_monitor_read(FAR struct file *filep, FAR char *buffer,
size_t buflen);
static ssize_t bat_monitor_write(FAR struct file *filep,
FAR const char *buffer, size_t buflen);
static int bat_monitor_ioctl(FAR struct file *filep, int cmd,
unsigned long arg);
static int bat_monitor_poll(FAR struct file *filep,
FAR struct pollfd *fds, bool setup);
/****************************************************************************
* Private Data
****************************************************************************/
static const struct file_operations g_batteryops =
{
bat_monitor_open, /* open */
bat_monitor_close, /* close */
bat_monitor_read, /* read */
bat_monitor_write, /* write */
NULL, /* seek */
bat_monitor_ioctl, /* ioctl */
bat_monitor_poll /* poll */
#ifndef CONFIG_DISABLE_PSEUDOFS_OPERATIONS
, NULL /* unlink */
#endif
};
/****************************************************************************
* Private Functions
****************************************************************************/
static int battery_monitor_notify(FAR struct battery_monitor_priv_s *priv,
uint32_t mask)
{
FAR struct pollfd *fd = priv->fds;
int semcnt;
int ret;
if (!fd)
{
return OK;
}
ret = nxsem_wait_uninterruptible(&priv->lock);
if (ret < 0)
{
return ret;
}
priv->mask |= mask;
if (priv->mask)
{
fd->revents |= POLLIN;
nxsem_get_value(fd->sem, &semcnt);
if (semcnt < 1)
{
nxsem_post(fd->sem);
}
nxsem_get_value(&priv->wait, &semcnt);
if (semcnt < 1)
{
nxsem_post(&priv->wait);
}
}
nxsem_post(&priv->lock);
return OK;
}
/****************************************************************************
* Name: bat_monitor_open
*
* Description:
* This function is called whenever the battery device is opened.
*
****************************************************************************/
static int bat_monitor_open(FAR struct file *filep)
{
FAR struct battery_monitor_priv_s *priv;
FAR struct battery_monitor_dev_s *dev = filep->f_inode->i_private;
int ret;
priv = kmm_zalloc(sizeof(*priv));
if (priv == NULL)
{
return -ENOMEM;
}
ret = nxsem_wait(&dev->batsem);
if (ret < 0)
{
kmm_free(priv);
return ret;
}
nxsem_init(&priv->lock, 0, 1);
nxsem_init(&priv->wait, 0, 0);
nxsem_set_protocol(&priv->wait, SEM_PRIO_NONE);
priv->mask = dev->mask;
list_add_tail(&dev->flist, &priv->node);
nxsem_post(&dev->batsem);
filep->f_priv = priv;
return ret;
}
/****************************************************************************
* Name: bat_monitor_close
*
* Description:
* This routine is called when the battery device is closed.
*
****************************************************************************/
static int bat_monitor_close(FAR struct file *filep)
{
FAR struct battery_monitor_priv_s *priv = filep->f_priv;
FAR struct battery_monitor_dev_s *dev = filep->f_inode->i_private;
int ret;
ret = nxsem_wait(&dev->batsem);
if (ret < 0)
{
return ret;
}
list_delete(&priv->node);
nxsem_post(&dev->batsem);
nxsem_destroy(&priv->lock);
nxsem_destroy(&priv->wait);
kmm_free(priv);
return OK;
}
/****************************************************************************
* Name: bat_monitor_read
****************************************************************************/
static ssize_t bat_monitor_read(FAR struct file *filep, FAR char *buffer,
size_t buflen)
{
FAR struct battery_monitor_priv_s *priv = filep->f_priv;
int ret;
if (buflen < sizeof(priv->mask))
{
return -EINVAL;
}
ret = nxsem_wait(&priv->lock);
if (ret < 0)
{
return ret;
}
while (priv->mask == 0)
{
nxsem_post(&priv->lock);
if (filep->f_oflags & O_NONBLOCK)
{
return -EAGAIN;
}
ret = nxsem_wait(&priv->wait);
if (ret < 0)
{
return ret;
}
ret = nxsem_wait(&priv->lock);
if (ret < 0)
{
return ret;
}
}
memcpy(buffer, &priv->mask, sizeof(priv->mask));
priv->mask = 0;
nxsem_post(&priv->lock);
return sizeof(priv->mask);
}
/****************************************************************************
* Name: bat_monitor_write
****************************************************************************/
static ssize_t bat_monitor_write(FAR struct file *filep,
FAR const char *buffer, size_t buflen)
{
/* Return nothing written */
return 0;
}
/****************************************************************************
* Name: bat_monitor_ioctl
****************************************************************************/
static int bat_monitor_ioctl(FAR struct file *filep, int cmd,
unsigned long arg)
{
FAR struct inode *inode = filep->f_inode;
FAR struct battery_monitor_dev_s *dev = inode->i_private;
int ret;
/* Enforce mutually exclusive access to the battery driver */
ret = nxsem_wait(&dev->batsem);
if (ret < 0)
{
return ret; /* Probably -EINTR */
}
/* Process the IOCTL command */
ret = -EINVAL; /* Assume a bad argument */
switch (cmd)
{
case BATIOC_STATE:
{
FAR int *ptr = (FAR int *)((uintptr_t)arg);
if (ptr)
{
ret = dev->ops->state(dev, ptr);
}
}
break;
case BATIOC_HEALTH:
{
FAR int *ptr = (FAR int *)((uintptr_t)arg);
if (ptr)
{
ret = dev->ops->health(dev, ptr);
}
}
break;
case BATIOC_ONLINE:
{
FAR bool *ptr = (FAR bool *)((uintptr_t)arg);
if (ptr)
{
ret = dev->ops->online(dev, ptr);
}
}
break;
case BATIOC_VOLTAGE:
{
FAR int *voltsp = (FAR int *)((uintptr_t)arg);
if (voltsp)
{
ret = dev->ops->voltage(dev, voltsp);
}
}
break;
case BATIOC_CURRENT:
{
FAR struct battery_monitor_current_s *current =
(FAR struct battery_monitor_current_s *)((uintptr_t)arg);
if (current)
{
ret = dev->ops->current(dev, current);
}
}
break;
case BATIOC_OPERATE:
{
FAR int *ptr = (FAR int *)((uintptr_t)arg);
if (ptr)
{
ret = dev->ops->operate(dev, (uintptr_t)arg);
}
}
break;
case BATIOC_CELLVOLTAGE:
{
FAR struct battery_monitor_voltage_s *ptr =
(FAR struct battery_monitor_voltage_s *)((uintptr_t)arg);
if (ptr)
{
ret = dev->ops->cell_voltage(dev, ptr);
}
}
break;
case BATIOC_BALANCE:
{
FAR struct battery_monitor_balance_s *ptr =
(FAR struct battery_monitor_balance_s *)((uintptr_t)arg);
if (ptr)
{
ret = dev->ops->balance(dev, ptr);
}
}
break;
case BATIOC_SHUTDOWN:
{
/* Options are not currently used by shutdown */
ret = dev->ops->shutdown(dev, (uintptr_t)arg);
}
break;
case BATIOC_SETLIMITS:
{
FAR struct battery_monitor_limits_s *ptr =
(FAR struct battery_monitor_limits_s *)((uintptr_t)arg);
if (ptr)
{
ret = dev->ops->setlimits(dev, ptr);
}
}
break;
case BATIOC_CHGDSG:
{
FAR struct battery_monitor_switches_s *ptr =
(FAR struct battery_monitor_switches_s *)((uintptr_t)arg);
if (ptr)
{
ret = dev->ops->chgdsg(dev, ptr);
}
}
break;
case BATIOC_CLEARFAULTS:
{
/* Options are not currently used by clear faults operation */
ret = dev->ops->clearfaults(dev, (uintptr_t)arg);
}
break;
case BATIOC_TEMPERATURE:
{
FAR struct battery_monitor_temperature_s *ptr =
(FAR struct battery_monitor_temperature_s *)((uintptr_t)arg);
if (ptr)
{
ret = dev->ops->temperature(dev, ptr);
}
}
break;
case BATIOC_COULOMBS:
{
FAR int *coulombp = (FAR int *)((uintptr_t)arg);
if (coulombp)
{
ret = dev->ops->coulombs(dev, coulombp);
}
}
break;
case BATIOC_CHIPID:
{
FAR unsigned int *ptr = (FAR unsigned int *)((uintptr_t)arg);
if (ptr)
{
ret = dev->ops->chipid(dev, ptr);
}
}
break;
default:
_err("ERROR: Unrecognized cmd: %d\n", cmd);
ret = -ENOTTY;
break;
}
nxsem_post(&dev->batsem);
return ret;
}
/****************************************************************************
* Name: bat_monitor_poll
****************************************************************************/
static ssize_t bat_monitor_poll(FAR struct file *filep,
struct pollfd *fds, bool setup)
{
FAR struct battery_monitor_priv_s *priv = filep->f_priv;
int ret;
ret = nxsem_wait(&priv->lock);
if (ret < 0)
{
return ret;
}
if (setup)
{
if (priv->fds == NULL)
{
priv->fds = fds;
fds->priv = &priv->fds;
}
else
{
ret = -EBUSY;
}
}
else if (fds->priv != NULL)
{
priv->fds = NULL;
fds->priv = NULL;
}
nxsem_post(&priv->lock);
if (setup)
{
battery_monitor_notify(priv, 0);
}
return ret;
}
/****************************************************************************
* Public Functions
****************************************************************************/
int battery_monitor_changed(FAR struct battery_monitor_dev_s *dev,
uint32_t mask)
{
FAR struct battery_monitor_priv_s *priv;
int ret;
ret = nxsem_wait_uninterruptible(&dev->batsem);
if (ret < 0)
{
return ret;
}
dev->mask |= mask;
list_for_every_entry(&dev->flist, priv,
struct battery_monitor_priv_s, node)
{
battery_monitor_notify(priv, mask);
}
nxsem_post(&dev->batsem);
return OK;
}
/****************************************************************************
* Name: battery_monitor_register
*
* Description:
* Register a lower half battery driver with the common, upper-half
* battery driver.
*
* Input Parameters:
* devpath - The location in the pseudo-filesystem to create the driver.
* Recommended standard is "/dev/bat0", "/dev/bat1", etc.
* dev - An instance of the battery state structure .
*
* Returned Value:
* Zero on success or a negated errno value on failure.
*
****************************************************************************/
int battery_monitor_register(FAR const char *devpath,
FAR struct battery_monitor_dev_s *dev)
{
int ret;
/* Initialize the semaphore and the list */
nxsem_init(&dev->batsem, 0, 1);
list_initialize(&dev->flist);
/* Register the character driver */
ret = register_driver(devpath, &g_batteryops, 0555, dev);
if (ret < 0)
{
_err("ERROR: Failed to register driver: %d\n", ret);
}
return ret;
}
#endif /* CONFIG_BATTERY_MONITOR */