[mirror_ubuntu-bionic-kernel.git] / drivers / media / cec / cec-api.c

/*
 * cec-api.c - HDMI Consumer Electronics Control framework - API
 *
 * Copyright 2016 Cisco Systems, Inc. and/or its affiliates. All rights reserved.
 *
 * This program is free software; you may 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.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
 * SOFTWARE.
 */

#include <linux/errno.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/kmod.h>
#include <linux/ktime.h>
#include <linux/slab.h>
#include <linux/mm.h>
#include <linux/string.h>
#include <linux/types.h>
#include <linux/uaccess.h>
#include <linux/version.h>

#include <media/cec-pin.h>
#include "cec-priv.h"
#include "cec-pin-priv.h"

static inline struct cec_devnode *cec_devnode_data(struct file *filp)
{
	struct cec_fh *fh = filp->private_data;

	return &fh->adap->devnode;
}

/* CEC file operations */

static unsigned int cec_poll(struct file *filp,
			     struct poll_table_struct *poll)
{
	struct cec_devnode *devnode = cec_devnode_data(filp);
	struct cec_fh *fh = filp->private_data;
	struct cec_adapter *adap = fh->adap;
	unsigned int res = 0;

	if (!devnode->registered)
		return POLLERR | POLLHUP;
	mutex_lock(&adap->lock);
	if (adap->is_configured &&
	    adap->transmit_queue_sz < CEC_MAX_MSG_TX_QUEUE_SZ)
		res |= POLLOUT | POLLWRNORM;
	if (fh->queued_msgs)
		res |= POLLIN | POLLRDNORM;
	if (fh->total_queued_events)
		res |= POLLPRI;
	poll_wait(filp, &fh->wait, poll);
	mutex_unlock(&adap->lock);
	return res;
}

static bool cec_is_busy(const struct cec_adapter *adap,
			const struct cec_fh *fh)
{
	bool valid_initiator = adap->cec_initiator && adap->cec_initiator == fh;
	bool valid_follower = adap->cec_follower && adap->cec_follower == fh;

	/*
	 * Exclusive initiators and followers can always access the CEC adapter
	 */
	if (valid_initiator || valid_follower)
		return false;
	/*
	 * All others can only access the CEC adapter if there is no
	 * exclusive initiator and they are in INITIATOR mode.
	 */
	return adap->cec_initiator ||
	       fh->mode_initiator == CEC_MODE_NO_INITIATOR;
}

static long cec_adap_g_caps(struct cec_adapter *adap,
			    struct cec_caps __user *parg)
{
	struct cec_caps caps = {};

	strlcpy(caps.driver, adap->devnode.dev.parent->driver->name,
		sizeof(caps.driver));
	strlcpy(caps.name, adap->name, sizeof(caps.name));
	caps.available_log_addrs = adap->available_log_addrs;
	caps.capabilities = adap->capabilities;
	caps.version = LINUX_VERSION_CODE;
	if (copy_to_user(parg, &caps, sizeof(caps)))
		return -EFAULT;
	return 0;
}

static long cec_adap_g_phys_addr(struct cec_adapter *adap,
				 __u16 __user *parg)
{
	u16 phys_addr;

	mutex_lock(&adap->lock);
	phys_addr = adap->phys_addr;
	mutex_unlock(&adap->lock);
	if (copy_to_user(parg, &phys_addr, sizeof(phys_addr)))
		return -EFAULT;
	return 0;
}

static int cec_validate_phys_addr(u16 phys_addr)
{
	int i;

	if (phys_addr == CEC_PHYS_ADDR_INVALID)
		return 0;
	for (i = 0; i < 16; i += 4)
		if (phys_addr & (0xf << i))
			break;
	if (i == 16)
		return 0;
	for (i += 4; i < 16; i += 4)
		if ((phys_addr & (0xf << i)) == 0)
			return -EINVAL;
	return 0;
}

static long cec_adap_s_phys_addr(struct cec_adapter *adap, struct cec_fh *fh,
				 bool block, __u16 __user *parg)
{
	u16 phys_addr;
	long err;

	if (!(adap->capabilities & CEC_CAP_PHYS_ADDR))
		return -ENOTTY;
	if (copy_from_user(&phys_addr, parg, sizeof(phys_addr)))
		return -EFAULT;

	err = cec_validate_phys_addr(phys_addr);
	if (err)
		return err;
	mutex_lock(&adap->lock);
	if (cec_is_busy(adap, fh))
		err = -EBUSY;
	else
		__cec_s_phys_addr(adap, phys_addr, block);
	mutex_unlock(&adap->lock);
	return err;
}

static long cec_adap_g_log_addrs(struct cec_adapter *adap,
				 struct cec_log_addrs __user *parg)
{
	struct cec_log_addrs log_addrs;

	mutex_lock(&adap->lock);
	log_addrs = adap->log_addrs;
	if (!adap->is_configured)
		memset(log_addrs.log_addr, CEC_LOG_ADDR_INVALID,
		       sizeof(log_addrs.log_addr));
	mutex_unlock(&adap->lock);

	if (copy_to_user(parg, &log_addrs, sizeof(log_addrs)))
		return -EFAULT;
	return 0;
}

static long cec_adap_s_log_addrs(struct cec_adapter *adap, struct cec_fh *fh,
				 bool block, struct cec_log_addrs __user *parg)
{
	struct cec_log_addrs log_addrs;
	long err = -EBUSY;

	if (!(adap->capabilities & CEC_CAP_LOG_ADDRS))
		return -ENOTTY;
	if (copy_from_user(&log_addrs, parg, sizeof(log_addrs)))
		return -EFAULT;
	log_addrs.flags &= CEC_LOG_ADDRS_FL_ALLOW_UNREG_FALLBACK |
			   CEC_LOG_ADDRS_FL_ALLOW_RC_PASSTHRU |
			   CEC_LOG_ADDRS_FL_CDC_ONLY;
	mutex_lock(&adap->lock);
	if (!adap->is_configuring &&
	    (!log_addrs.num_log_addrs || !adap->is_configured) &&
	    !cec_is_busy(adap, fh)) {
		err = __cec_s_log_addrs(adap, &log_addrs, block);
		if (!err)
			log_addrs = adap->log_addrs;
	}
	mutex_unlock(&adap->lock);
	if (err)
		return err;
	if (copy_to_user(parg, &log_addrs, sizeof(log_addrs)))
		return -EFAULT;
	return 0;
}

static long cec_transmit(struct cec_adapter *adap, struct cec_fh *fh,
			 bool block, struct cec_msg __user *parg)
{
	struct cec_msg msg = {};
	long err = 0;

	if (!(adap->capabilities & CEC_CAP_TRANSMIT))
		return -ENOTTY;
	if (copy_from_user(&msg, parg, sizeof(msg)))
		return -EFAULT;

	/* A CDC-Only device can only send CDC messages */
	if ((adap->log_addrs.flags & CEC_LOG_ADDRS_FL_CDC_ONLY) &&
	    (msg.len == 1 || msg.msg[1] != CEC_MSG_CDC_MESSAGE))
		return -EINVAL;

	mutex_lock(&adap->lock);
	if (adap->log_addrs.num_log_addrs == 0)
		err = -EPERM;
	else if (adap->is_configuring)
		err = -ENONET;
	else if (!adap->is_configured &&
		 (adap->needs_hpd || msg.msg[0] != 0xf0))
		err = -ENONET;
	else if (cec_is_busy(adap, fh))
		err = -EBUSY;
	else
		err = cec_transmit_msg_fh(adap, &msg, fh, block);
	mutex_unlock(&adap->lock);
	if (err)
		return err;
	if (copy_to_user(parg, &msg, sizeof(msg)))
		return -EFAULT;
	return 0;
}

/* Called by CEC_RECEIVE: wait for a message to arrive */
static int cec_receive_msg(struct cec_fh *fh, struct cec_msg *msg, bool block)
{
	u32 timeout = msg->timeout;
	int res;

	do {
		mutex_lock(&fh->lock);
		/* Are there received messages queued up? */
		if (fh->queued_msgs) {
			/* Yes, return the first one */
			struct cec_msg_entry *entry =
				list_first_entry(&fh->msgs,
						 struct cec_msg_entry, list);

			list_del(&entry->list);
			*msg = entry->msg;
			kfree(entry);
			fh->queued_msgs--;
			mutex_unlock(&fh->lock);
			/* restore original timeout value */
			msg->timeout = timeout;
			return 0;
		}

		/* No, return EAGAIN in non-blocking mode or wait */
		mutex_unlock(&fh->lock);

		/* Return when in non-blocking mode */
		if (!block)
			return -EAGAIN;

		if (msg->timeout) {
			/* The user specified a timeout */
			res = wait_event_interruptible_timeout(fh->wait,
							       fh->queued_msgs,
				msecs_to_jiffies(msg->timeout));
			if (res == 0)
				res = -ETIMEDOUT;
			else if (res > 0)
				res = 0;
		} else {
			/* Wait indefinitely */
			res = wait_event_interruptible(fh->wait,
						       fh->queued_msgs);
		}
		/* Exit on error, otherwise loop to get the new message */
	} while (!res);
	return res;
}

static long cec_receive(struct cec_adapter *adap, struct cec_fh *fh,
			bool block, struct cec_msg __user *parg)
{
	struct cec_msg msg = {};
	long err;

	if (copy_from_user(&msg, parg, sizeof(msg)))
		return -EFAULT;

	err = cec_receive_msg(fh, &msg, block);
	if (err)
		return err;
	msg.flags = 0;
	if (copy_to_user(parg, &msg, sizeof(msg)))
		return -EFAULT;
	return 0;
}

static long cec_dqevent(struct cec_adapter *adap, struct cec_fh *fh,
			bool block, struct cec_event __user *parg)
{
	struct cec_event_entry *ev = NULL;
	u64 ts = ~0ULL;
	unsigned int i;
	unsigned int ev_idx;
	long err = 0;

	mutex_lock(&fh->lock);
	while (!fh->total_queued_events && block) {
		mutex_unlock(&fh->lock);
		err = wait_event_interruptible(fh->wait,
					       fh->total_queued_events);
		if (err)
			return err;
		mutex_lock(&fh->lock);
	}

	/* Find the oldest event */
	for (i = 0; i < CEC_NUM_EVENTS; i++) {
		struct cec_event_entry *entry =
			list_first_entry_or_null(&fh->events[i],
						 struct cec_event_entry, list);

		if (entry && entry->ev.ts <= ts) {
			ev = entry;
			ev_idx = i;
			ts = ev->ev.ts;
		}
	}

	if (!ev) {
		err = -EAGAIN;
		goto unlock;
	}
	list_del(&ev->list);

	if (copy_to_user(parg, &ev->ev, sizeof(ev->ev)))
		err = -EFAULT;
	if (ev_idx >= CEC_NUM_CORE_EVENTS)
		kfree(ev);
	fh->queued_events[ev_idx]--;
	fh->total_queued_events--;

unlock:
	mutex_unlock(&fh->lock);
	return err;
}

static long cec_g_mode(struct cec_adapter *adap, struct cec_fh *fh,
		       u32 __user *parg)
{
	u32 mode = fh->mode_initiator | fh->mode_follower;

	if (copy_to_user(parg, &mode, sizeof(mode)))
		return -EFAULT;
	return 0;
}

static long cec_s_mode(struct cec_adapter *adap, struct cec_fh *fh,
		       u32 __user *parg)
{
	u32 mode;
	u8 mode_initiator;
	u8 mode_follower;
	long err = 0;

	if (copy_from_user(&mode, parg, sizeof(mode)))
		return -EFAULT;
	if (mode & ~(CEC_MODE_INITIATOR_MSK | CEC_MODE_FOLLOWER_MSK)) {
		dprintk(1, "%s: invalid mode bits set\n", __func__);
		return -EINVAL;
	}

	mode_initiator = mode & CEC_MODE_INITIATOR_MSK;
	mode_follower = mode & CEC_MODE_FOLLOWER_MSK;

	if (mode_initiator > CEC_MODE_EXCL_INITIATOR ||
	    mode_follower > CEC_MODE_MONITOR_ALL) {
		dprintk(1, "%s: unknown mode\n", __func__);
		return -EINVAL;
	}

	if (mode_follower == CEC_MODE_MONITOR_ALL &&
	    !(adap->capabilities & CEC_CAP_MONITOR_ALL)) {
		dprintk(1, "%s: MONITOR_ALL not supported\n", __func__);
		return -EINVAL;
	}

	if (mode_follower == CEC_MODE_MONITOR_PIN &&
	    !(adap->capabilities & CEC_CAP_MONITOR_PIN)) {
		dprintk(1, "%s: MONITOR_PIN not supported\n", __func__);
		return -EINVAL;
	}

	/* Follower modes should always be able to send CEC messages */
	if ((mode_initiator == CEC_MODE_NO_INITIATOR ||
	     !(adap->capabilities & CEC_CAP_TRANSMIT)) &&
	    mode_follower >= CEC_MODE_FOLLOWER &&
	    mode_follower <= CEC_MODE_EXCL_FOLLOWER_PASSTHRU) {
		dprintk(1, "%s: cannot transmit\n", __func__);
		return -EINVAL;
	}

	/* Monitor modes require CEC_MODE_NO_INITIATOR */
	if (mode_initiator && mode_follower >= CEC_MODE_MONITOR_PIN) {
		dprintk(1, "%s: monitor modes require NO_INITIATOR\n",
			__func__);
		return -EINVAL;
	}

	/* Monitor modes require CAP_NET_ADMIN */
	if (mode_follower >= CEC_MODE_MONITOR_PIN && !capable(CAP_NET_ADMIN))
		return -EPERM;

	mutex_lock(&adap->lock);
	/*
	 * You can't become exclusive follower if someone else already
	 * has that job.
	 */
	if ((mode_follower == CEC_MODE_EXCL_FOLLOWER ||
	     mode_follower == CEC_MODE_EXCL_FOLLOWER_PASSTHRU) &&
	    adap->cec_follower && adap->cec_follower != fh)
		err = -EBUSY;
	/*
	 * You can't become exclusive initiator if someone else already
	 * has that job.
	 */
	if (mode_initiator == CEC_MODE_EXCL_INITIATOR &&
	    adap->cec_initiator && adap->cec_initiator != fh)
		err = -EBUSY;

	if (!err) {
		bool old_mon_all = fh->mode_follower == CEC_MODE_MONITOR_ALL;
		bool new_mon_all = mode_follower == CEC_MODE_MONITOR_ALL;

		if (old_mon_all != new_mon_all) {
			if (new_mon_all)
				err = cec_monitor_all_cnt_inc(adap);
			else
				cec_monitor_all_cnt_dec(adap);
		}
	}

	if (err) {
		mutex_unlock(&adap->lock);
		return err;
	}

	if (fh->mode_follower == CEC_MODE_FOLLOWER)
		adap->follower_cnt--;
	if (fh->mode_follower == CEC_MODE_MONITOR_PIN)
		adap->monitor_pin_cnt--;
	if (mode_follower == CEC_MODE_FOLLOWER)
		adap->follower_cnt++;
	if (mode_follower == CEC_MODE_MONITOR_PIN) {
		struct cec_event ev = {
			.flags = CEC_EVENT_FL_INITIAL_STATE,
		};

		ev.event = adap->cec_pin_is_high ? CEC_EVENT_PIN_CEC_HIGH :
						   CEC_EVENT_PIN_CEC_LOW;
		cec_queue_event_fh(fh, &ev, 0);
		adap->monitor_pin_cnt++;
	}
	if (mode_follower == CEC_MODE_EXCL_FOLLOWER ||
	    mode_follower == CEC_MODE_EXCL_FOLLOWER_PASSTHRU) {
		adap->passthrough =
			mode_follower == CEC_MODE_EXCL_FOLLOWER_PASSTHRU;
		adap->cec_follower = fh;
	} else if (adap->cec_follower == fh) {
		adap->passthrough = false;
		adap->cec_follower = NULL;
	}
	if (mode_initiator == CEC_MODE_EXCL_INITIATOR)
		adap->cec_initiator = fh;
	else if (adap->cec_initiator == fh)
		adap->cec_initiator = NULL;
	fh->mode_initiator = mode_initiator;
	fh->mode_follower = mode_follower;
	mutex_unlock(&adap->lock);
	return 0;
}

static long cec_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
{
	struct cec_devnode *devnode = cec_devnode_data(filp);
	struct cec_fh *fh = filp->private_data;
	struct cec_adapter *adap = fh->adap;
	bool block = !(filp->f_flags & O_NONBLOCK);
	void __user *parg = (void __user *)arg;

	if (!devnode->registered)
		return -ENODEV;

	switch (cmd) {
	case CEC_ADAP_G_CAPS:
		return cec_adap_g_caps(adap, parg);

	case CEC_ADAP_G_PHYS_ADDR:
		return cec_adap_g_phys_addr(adap, parg);

	case CEC_ADAP_S_PHYS_ADDR:
		return cec_adap_s_phys_addr(adap, fh, block, parg);

	case CEC_ADAP_G_LOG_ADDRS:
		return cec_adap_g_log_addrs(adap, parg);

	case CEC_ADAP_S_LOG_ADDRS:
		return cec_adap_s_log_addrs(adap, fh, block, parg);

	case CEC_TRANSMIT:
		return cec_transmit(adap, fh, block, parg);

	case CEC_RECEIVE:
		return cec_receive(adap, fh, block, parg);

	case CEC_DQEVENT:
		return cec_dqevent(adap, fh, block, parg);

	case CEC_G_MODE:
		return cec_g_mode(adap, fh, parg);

	case CEC_S_MODE:
		return cec_s_mode(adap, fh, parg);

	default:
		return -ENOTTY;
	}
}

static int cec_open(struct inode *inode, struct file *filp)
{
	struct cec_devnode *devnode =
		container_of(inode->i_cdev, struct cec_devnode, cdev);
	struct cec_adapter *adap = to_cec_adapter(devnode);
	struct cec_fh *fh = kzalloc(sizeof(*fh), GFP_KERNEL);
	/*
	 * Initial events that are automatically sent when the cec device is
	 * opened.
	 */
	struct cec_event ev = {
		.event = CEC_EVENT_STATE_CHANGE,
		.flags = CEC_EVENT_FL_INITIAL_STATE,
	};
	unsigned int i;
	int err;

	if (!fh)
		return -ENOMEM;

	INIT_LIST_HEAD(&fh->msgs);
	INIT_LIST_HEAD(&fh->xfer_list);
	for (i = 0; i < CEC_NUM_EVENTS; i++)
		INIT_LIST_HEAD(&fh->events[i]);
	mutex_init(&fh->lock);
	init_waitqueue_head(&fh->wait);

	fh->mode_initiator = CEC_MODE_INITIATOR;
	fh->adap = adap;

	err = cec_get_device(devnode);
	if (err) {
		kfree(fh);
		return err;
	}

	mutex_lock(&devnode->lock);
	if (list_empty(&devnode->fhs) &&
	    !adap->needs_hpd &&
	    adap->phys_addr == CEC_PHYS_ADDR_INVALID) {
		err = adap->ops->adap_enable(adap, true);
		if (err) {
			mutex_unlock(&devnode->lock);
			kfree(fh);
			return err;
		}
	}
	filp->private_data = fh;

	/* Queue up initial state events */
	ev.state_change.phys_addr = adap->phys_addr;
	ev.state_change.log_addr_mask = adap->log_addrs.log_addr_mask;
	cec_queue_event_fh(fh, &ev, 0);
#ifdef CONFIG_CEC_PIN
	if (adap->pin && adap->pin->ops->read_hpd) {
		err = adap->pin->ops->read_hpd(adap);
		if (err >= 0) {
			ev.event = err ? CEC_EVENT_PIN_HPD_HIGH :
					 CEC_EVENT_PIN_HPD_LOW;
			cec_queue_event_fh(fh, &ev, 0);
		}
	}
#endif

	list_add(&fh->list, &devnode->fhs);
	mutex_unlock(&devnode->lock);

	return 0;
}

/* Override for the release function */
static int cec_release(struct inode *inode, struct file *filp)
{
	struct cec_devnode *devnode = cec_devnode_data(filp);
	struct cec_adapter *adap = to_cec_adapter(devnode);
	struct cec_fh *fh = filp->private_data;
	unsigned int i;

	mutex_lock(&adap->lock);
	if (adap->cec_initiator == fh)
		adap->cec_initiator = NULL;
	if (adap->cec_follower == fh) {
		adap->cec_follower = NULL;
		adap->passthrough = false;
	}
	if (fh->mode_follower == CEC_MODE_FOLLOWER)
		adap->follower_cnt--;
	if (fh->mode_follower == CEC_MODE_MONITOR_PIN)
		adap->monitor_pin_cnt--;
	if (fh->mode_follower == CEC_MODE_MONITOR_ALL)
		cec_monitor_all_cnt_dec(adap);
	mutex_unlock(&adap->lock);

	mutex_lock(&devnode->lock);
	list_del(&fh->list);
	if (list_empty(&devnode->fhs) &&
	    !adap->needs_hpd &&
	    adap->phys_addr == CEC_PHYS_ADDR_INVALID) {
		WARN_ON(adap->ops->adap_enable(adap, false));
	}
	mutex_unlock(&devnode->lock);

	/* Unhook pending transmits from this filehandle. */
	mutex_lock(&adap->lock);
	while (!list_empty(&fh->xfer_list)) {
		struct cec_data *data =
			list_first_entry(&fh->xfer_list, struct cec_data, xfer_list);

		data->blocking = false;
		data->fh = NULL;
		list_del(&data->xfer_list);
	}
	mutex_unlock(&adap->lock);
	while (!list_empty(&fh->msgs)) {
		struct cec_msg_entry *entry =
			list_first_entry(&fh->msgs, struct cec_msg_entry, list);

		list_del(&entry->list);
		kfree(entry);
	}
	for (i = CEC_NUM_CORE_EVENTS; i < CEC_NUM_EVENTS; i++) {
		while (!list_empty(&fh->events[i])) {
			struct cec_event_entry *entry =
				list_first_entry(&fh->events[i],
						 struct cec_event_entry, list);

			list_del(&entry->list);
			kfree(entry);
		}
	}
	kfree(fh);

	cec_put_device(devnode);
	filp->private_data = NULL;
	return 0;
}

const struct file_operations cec_devnode_fops = {
	.owner = THIS_MODULE,
	.open = cec_open,
	.unlocked_ioctl = cec_ioctl,
	.release = cec_release,
	.poll = cec_poll,
	.llseek = no_llseek,
};
Commit	Line	Data
ca684386 HV	1	/*
	2	* cec-api.c - HDMI Consumer Electronics Control framework - API
	3	*
	4	* Copyright 2016 Cisco Systems, Inc. and/or its affiliates. All rights reserved.
	5	*
	6	* This program is free software; you may redistribute it and/or modify
	7	* it under the terms of the GNU General Public License as published by
	8	* the Free Software Foundation; version 2 of the License.
	9	*
	10	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
	11	* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
	12	* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
	13	* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
	14	* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
	15	* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
	16	* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
	17	* SOFTWARE.
	18	*/
	19
	20	#include <linux/errno.h>
	21	#include <linux/init.h>
	22	#include <linux/module.h>
	23	#include <linux/kernel.h>
	24	#include <linux/kmod.h>
	25	#include <linux/ktime.h>
	26	#include <linux/slab.h>
	27	#include <linux/mm.h>
	28	#include <linux/string.h>
	29	#include <linux/types.h>
	30	#include <linux/uaccess.h>
	31	#include <linux/version.h>
	32
ea5c8ef2	33	#include <media/cec-pin.h>
ca684386	34	#include "cec-priv.h"
5bf24e08	35	#include "cec-pin-priv.h"
ca684386 HV	36
	37	static inline struct cec_devnode cec_devnode_data(struct file filp)
	38	{
	39	struct cec_fh *fh = filp->private_data;
	40
	41	return &fh->adap->devnode;
	42	}
	43
	44	/* CEC file operations */
	45
	46	static unsigned int cec_poll(struct file *filp,
	47	struct poll_table_struct *poll)
	48	{
	49	struct cec_devnode *devnode = cec_devnode_data(filp);
	50	struct cec_fh *fh = filp->private_data;
	51	struct cec_adapter *adap = fh->adap;
	52	unsigned int res = 0;
	53
	54	if (!devnode->registered)
	55	return POLLERR \| POLLHUP;
	56	mutex_lock(&adap->lock);
b7cbc892 HV	57	if (adap->is_configured &&
b7cbc892 HV	58	adap->transmit_queue_sz < CEC_MAX_MSG_TX_QUEUE_SZ)
ca684386 HV	59	res \|= POLLOUT \| POLLWRNORM;
	60	if (fh->queued_msgs)
	61	res \|= POLLIN \| POLLRDNORM;
6b2bbb08	62	if (fh->total_queued_events)
ca684386 HV	63	res \|= POLLPRI;
	64	poll_wait(filp, &fh->wait, poll);
	65	mutex_unlock(&adap->lock);
	66	return res;
	67	}
	68
	69	static bool cec_is_busy(const struct cec_adapter *adap,
	70	const struct cec_fh *fh)
	71	{
	72	bool valid_initiator = adap->cec_initiator && adap->cec_initiator == fh;
	73	bool valid_follower = adap->cec_follower && adap->cec_follower == fh;
	74
	75	/*
	76	* Exclusive initiators and followers can always access the CEC adapter
	77	*/
	78	if (valid_initiator \|\| valid_follower)
	79	return false;
	80	/*
	81	* All others can only access the CEC adapter if there is no
	82	* exclusive initiator and they are in INITIATOR mode.
	83	*/
	84	return adap->cec_initiator \|\|
	85	fh->mode_initiator == CEC_MODE_NO_INITIATOR;
	86	}
	87
	88	static long cec_adap_g_caps(struct cec_adapter *adap,
	89	struct cec_caps __user *parg)
	90	{
	91	struct cec_caps caps = {};
	92
f51e8080	93	strlcpy(caps.driver, adap->devnode.dev.parent->driver->name,
ca684386 HV	94	sizeof(caps.driver));
	95	strlcpy(caps.name, adap->name, sizeof(caps.name));
	96	caps.available_log_addrs = adap->available_log_addrs;
	97	caps.capabilities = adap->capabilities;
	98	caps.version = LINUX_VERSION_CODE;
	99	if (copy_to_user(parg, &caps, sizeof(caps)))
	100	return -EFAULT;
	101	return 0;
	102	}
	103
	104	static long cec_adap_g_phys_addr(struct cec_adapter *adap,
	105	__u16 __user *parg)
	106	{
	107	u16 phys_addr;
	108
	109	mutex_lock(&adap->lock);
	110	phys_addr = adap->phys_addr;
	111	mutex_unlock(&adap->lock);
	112	if (copy_to_user(parg, &phys_addr, sizeof(phys_addr)))
	113	return -EFAULT;
	114	return 0;
	115	}
	116
5dcc0d74 HV	117	static int cec_validate_phys_addr(u16 phys_addr)
	118	{
	119	int i;
	120
	121	if (phys_addr == CEC_PHYS_ADDR_INVALID)
	122	return 0;
	123	for (i = 0; i < 16; i += 4)
	124	if (phys_addr & (0xf << i))
	125	break;
	126	if (i == 16)
	127	return 0;
	128	for (i += 4; i < 16; i += 4)
	129	if ((phys_addr & (0xf << i)) == 0)
	130	return -EINVAL;
	131	return 0;
	132	}
	133
ca684386 HV	134	static long cec_adap_s_phys_addr(struct cec_adapter adap, struct cec_fh fh,
	135	bool block, __u16 __user *parg)
	136	{
	137	u16 phys_addr;
	138	long err;
	139
	140	if (!(adap->capabilities & CEC_CAP_PHYS_ADDR))
	141	return -ENOTTY;
	142	if (copy_from_user(&phys_addr, parg, sizeof(phys_addr)))
	143	return -EFAULT;
	144
5dcc0d74	145	err = cec_validate_phys_addr(phys_addr);
ca684386 HV	146	if (err)
	147	return err;
	148	mutex_lock(&adap->lock);
	149	if (cec_is_busy(adap, fh))
	150	err = -EBUSY;
	151	else
	152	__cec_s_phys_addr(adap, phys_addr, block);
	153	mutex_unlock(&adap->lock);
	154	return err;
	155	}
	156
	157	static long cec_adap_g_log_addrs(struct cec_adapter *adap,
	158	struct cec_log_addrs __user *parg)
	159	{
	160	struct cec_log_addrs log_addrs;
	161
	162	mutex_lock(&adap->lock);
	163	log_addrs = adap->log_addrs;
	164	if (!adap->is_configured)
	165	memset(log_addrs.log_addr, CEC_LOG_ADDR_INVALID,
	166	sizeof(log_addrs.log_addr));
	167	mutex_unlock(&adap->lock);
	168
	169	if (copy_to_user(parg, &log_addrs, sizeof(log_addrs)))
	170	return -EFAULT;
	171	return 0;
	172	}
	173
	174	static long cec_adap_s_log_addrs(struct cec_adapter adap, struct cec_fh fh,
	175	bool block, struct cec_log_addrs __user *parg)
	176	{
	177	struct cec_log_addrs log_addrs;
	178	long err = -EBUSY;
	179
	180	if (!(adap->capabilities & CEC_CAP_LOG_ADDRS))
	181	return -ENOTTY;
	182	if (copy_from_user(&log_addrs, parg, sizeof(log_addrs)))
	183	return -EFAULT;
f4062625	184	log_addrs.flags &= CEC_LOG_ADDRS_FL_ALLOW_UNREG_FALLBACK \|
a69a168a HV	185	CEC_LOG_ADDRS_FL_ALLOW_RC_PASSTHRU \|
a69a168a HV	186	CEC_LOG_ADDRS_FL_CDC_ONLY;
ca684386 HV	187	mutex_lock(&adap->lock);
	188	if (!adap->is_configuring &&
	189	(!log_addrs.num_log_addrs \|\| !adap->is_configured) &&
	190	!cec_is_busy(adap, fh)) {
	191	err = __cec_s_log_addrs(adap, &log_addrs, block);
	192	if (!err)
	193	log_addrs = adap->log_addrs;
	194	}
	195	mutex_unlock(&adap->lock);
	196	if (err)
	197	return err;
	198	if (copy_to_user(parg, &log_addrs, sizeof(log_addrs)))
	199	return -EFAULT;
	200	return 0;
	201	}
	202
	203	static long cec_transmit(struct cec_adapter adap, struct cec_fh fh,
	204	bool block, struct cec_msg __user *parg)
	205	{
	206	struct cec_msg msg = {};
	207	long err = 0;
	208
	209	if (!(adap->capabilities & CEC_CAP_TRANSMIT))
	210	return -ENOTTY;
	211	if (copy_from_user(&msg, parg, sizeof(msg)))
	212	return -EFAULT;
a69a168a HV	213
	214	/* A CDC-Only device can only send CDC messages */
	215	if ((adap->log_addrs.flags & CEC_LOG_ADDRS_FL_CDC_ONLY) &&
	216	(msg.len == 1 \|\| msg.msg[1] != CEC_MSG_CDC_MESSAGE))
	217	return -EINVAL;
	218
ca684386	219	mutex_lock(&adap->lock);
059d1460 HV	220	if (adap->log_addrs.num_log_addrs == 0)
	221	err = -EPERM;
	222	else if (adap->is_configuring)
533a3f7b	223	err = -ENONET;
f902c1e9 HV	224	else if (!adap->is_configured &&
f902c1e9 HV	225	(adap->needs_hpd \|\| msg.msg[0] != 0xf0))
ca684386	226	err = -ENONET;
4eef404f	227	else if (cec_is_busy(adap, fh))
ca684386	228	err = -EBUSY;
4eef404f	229	else
ca684386	230	err = cec_transmit_msg_fh(adap, &msg, fh, block);
ca684386 HV	231	mutex_unlock(&adap->lock);
	232	if (err)
	233	return err;
	234	if (copy_to_user(parg, &msg, sizeof(msg)))
	235	return -EFAULT;
	236	return 0;
	237	}
	238
	239	/* Called by CEC_RECEIVE: wait for a message to arrive */
	240	static int cec_receive_msg(struct cec_fh fh, struct cec_msg msg, bool block)
	241	{
e883b4d0	242	u32 timeout = msg->timeout;
ca684386 HV	243	int res;
	244
	245	do {
	246	mutex_lock(&fh->lock);
	247	/* Are there received messages queued up? */
	248	if (fh->queued_msgs) {
	249	/* Yes, return the first one */
	250	struct cec_msg_entry *entry =
	251	list_first_entry(&fh->msgs,
	252	struct cec_msg_entry, list);
	253
	254	list_del(&entry->list);
	255	*msg = entry->msg;
	256	kfree(entry);
	257	fh->queued_msgs--;
	258	mutex_unlock(&fh->lock);
e883b4d0 HV	259	/* restore original timeout value */
e883b4d0 HV	260	msg->timeout = timeout;
ca684386 HV	261	return 0;
	262	}
	263
	264	/* No, return EAGAIN in non-blocking mode or wait */
	265	mutex_unlock(&fh->lock);
	266
	267	/* Return when in non-blocking mode */
	268	if (!block)
	269	return -EAGAIN;
	270
	271	if (msg->timeout) {
	272	/* The user specified a timeout */
	273	res = wait_event_interruptible_timeout(fh->wait,
	274	fh->queued_msgs,
	275	msecs_to_jiffies(msg->timeout));
	276	if (res == 0)
	277	res = -ETIMEDOUT;
	278	else if (res > 0)
	279	res = 0;
	280	} else {
	281	/* Wait indefinitely */
	282	res = wait_event_interruptible(fh->wait,
	283	fh->queued_msgs);
	284	}
	285	/* Exit on error, otherwise loop to get the new message */
	286	} while (!res);
	287	return res;
	288	}
	289
	290	static long cec_receive(struct cec_adapter adap, struct cec_fh fh,
	291	bool block, struct cec_msg __user *parg)
	292	{
	293	struct cec_msg msg = {};
b94aac64	294	long err;
ca684386 HV	295
	296	if (copy_from_user(&msg, parg, sizeof(msg)))
	297	return -EFAULT;
ca684386 HV	298
	299	err = cec_receive_msg(fh, &msg, block);
	300	if (err)
	301	return err;
7ae2a888	302	msg.flags = 0;
ca684386 HV	303	if (copy_to_user(parg, &msg, sizeof(msg)))
	304	return -EFAULT;
	305	return 0;
	306	}
	307
	308	static long cec_dqevent(struct cec_adapter adap, struct cec_fh fh,
	309	bool block, struct cec_event __user *parg)
	310	{
6b2bbb08	311	struct cec_event_entry *ev = NULL;
ca684386 HV	312	u64 ts = ~0ULL;
ca684386 HV	313	unsigned int i;
6b2bbb08	314	unsigned int ev_idx;
ca684386 HV	315	long err = 0;
	316
	317	mutex_lock(&fh->lock);
6b2bbb08	318	while (!fh->total_queued_events && block) {
ca684386	319	mutex_unlock(&fh->lock);
6b2bbb08 HV	320	err = wait_event_interruptible(fh->wait,
6b2bbb08 HV	321	fh->total_queued_events);
ca684386 HV	322	if (err)
	323	return err;
	324	mutex_lock(&fh->lock);
	325	}
	326
	327	/* Find the oldest event */
	328	for (i = 0; i < CEC_NUM_EVENTS; i++) {
6b2bbb08 HV	329	struct cec_event_entry *entry =
	330	list_first_entry_or_null(&fh->events[i],
	331	struct cec_event_entry, list);
	332
	333	if (entry && entry->ev.ts <= ts) {
	334	ev = entry;
	335	ev_idx = i;
	336	ts = ev->ev.ts;
ca684386 HV	337	}
ca684386 HV	338	}
6b2bbb08	339
ca684386 HV	340	if (!ev) {
	341	err = -EAGAIN;
	342	goto unlock;
	343	}
6b2bbb08	344	list_del(&ev->list);
ca684386	345
6b2bbb08	346	if (copy_to_user(parg, &ev->ev, sizeof(ev->ev)))
ca684386	347	err = -EFAULT;
6b2bbb08 HV	348	if (ev_idx >= CEC_NUM_CORE_EVENTS)
	349	kfree(ev);
	350	fh->queued_events[ev_idx]--;
	351	fh->total_queued_events--;
ca684386 HV	352
	353	unlock:
	354	mutex_unlock(&fh->lock);
	355	return err;
	356	}
	357
	358	static long cec_g_mode(struct cec_adapter adap, struct cec_fh fh,
	359	u32 __user *parg)
	360	{
	361	u32 mode = fh->mode_initiator \| fh->mode_follower;
	362
	363	if (copy_to_user(parg, &mode, sizeof(mode)))
	364	return -EFAULT;
	365	return 0;
	366	}
	367
	368	static long cec_s_mode(struct cec_adapter adap, struct cec_fh fh,
	369	u32 __user *parg)
	370	{
	371	u32 mode;
	372	u8 mode_initiator;
	373	u8 mode_follower;
	374	long err = 0;
	375
	376	if (copy_from_user(&mode, parg, sizeof(mode)))
	377	return -EFAULT;
c33da628 HV	378	if (mode & ~(CEC_MODE_INITIATOR_MSK \| CEC_MODE_FOLLOWER_MSK)) {
c33da628 HV	379	dprintk(1, "%s: invalid mode bits set\n", __func__);
ca684386	380	return -EINVAL;
c33da628	381	}
ca684386 HV	382
	383	mode_initiator = mode & CEC_MODE_INITIATOR_MSK;
	384	mode_follower = mode & CEC_MODE_FOLLOWER_MSK;
	385
	386	if (mode_initiator > CEC_MODE_EXCL_INITIATOR \|\|
c33da628 HV	387	mode_follower > CEC_MODE_MONITOR_ALL) {
c33da628 HV	388	dprintk(1, "%s: unknown mode\n", __func__);
ca684386	389	return -EINVAL;
c33da628	390	}
ca684386 HV	391
ca684386 HV	392	if (mode_follower == CEC_MODE_MONITOR_ALL &&
c33da628 HV	393	!(adap->capabilities & CEC_CAP_MONITOR_ALL)) {
c33da628 HV	394	dprintk(1, "%s: MONITOR_ALL not supported\n", __func__);
ca684386	395	return -EINVAL;
c33da628	396	}
ca684386	397
b8d62f50	398	if (mode_follower == CEC_MODE_MONITOR_PIN &&
c33da628 HV	399	!(adap->capabilities & CEC_CAP_MONITOR_PIN)) {
c33da628 HV	400	dprintk(1, "%s: MONITOR_PIN not supported\n", __func__);
b8d62f50	401	return -EINVAL;
c33da628	402	}
b8d62f50	403
ca684386 HV	404	/* Follower modes should always be able to send CEC messages */
	405	if ((mode_initiator == CEC_MODE_NO_INITIATOR \|\|
	406	!(adap->capabilities & CEC_CAP_TRANSMIT)) &&
	407	mode_follower >= CEC_MODE_FOLLOWER &&
c33da628 HV	408	mode_follower <= CEC_MODE_EXCL_FOLLOWER_PASSTHRU) {
c33da628 HV	409	dprintk(1, "%s: cannot transmit\n", __func__);
ca684386	410	return -EINVAL;
c33da628	411	}
ca684386 HV	412
ca684386 HV	413	/* Monitor modes require CEC_MODE_NO_INITIATOR */
c33da628 HV	414	if (mode_initiator && mode_follower >= CEC_MODE_MONITOR_PIN) {
	415	dprintk(1, "%s: monitor modes require NO_INITIATOR\n",
	416	__func__);
ca684386	417	return -EINVAL;
c33da628	418	}
ca684386 HV	419
ca684386 HV	420	/* Monitor modes require CAP_NET_ADMIN */
b8d62f50	421	if (mode_follower >= CEC_MODE_MONITOR_PIN && !capable(CAP_NET_ADMIN))
ca684386 HV	422	return -EPERM;
	423
	424	mutex_lock(&adap->lock);
	425	/*
	426	* You can't become exclusive follower if someone else already
	427	* has that job.
	428	*/
	429	if ((mode_follower == CEC_MODE_EXCL_FOLLOWER \|\|
	430	mode_follower == CEC_MODE_EXCL_FOLLOWER_PASSTHRU) &&
	431	adap->cec_follower && adap->cec_follower != fh)
	432	err = -EBUSY;
	433	/*
	434	* You can't become exclusive initiator if someone else already
	435	* has that job.
	436	*/
	437	if (mode_initiator == CEC_MODE_EXCL_INITIATOR &&
	438	adap->cec_initiator && adap->cec_initiator != fh)
	439	err = -EBUSY;
	440
	441	if (!err) {
	442	bool old_mon_all = fh->mode_follower == CEC_MODE_MONITOR_ALL;
	443	bool new_mon_all = mode_follower == CEC_MODE_MONITOR_ALL;
	444
	445	if (old_mon_all != new_mon_all) {
	446	if (new_mon_all)
	447	err = cec_monitor_all_cnt_inc(adap);
	448	else
	449	cec_monitor_all_cnt_dec(adap);
	450	}
	451	}
	452
	453	if (err) {
	454	mutex_unlock(&adap->lock);
	455	return err;
	456	}
	457
	458	if (fh->mode_follower == CEC_MODE_FOLLOWER)
	459	adap->follower_cnt--;
b8d62f50 HV	460	if (fh->mode_follower == CEC_MODE_MONITOR_PIN)
b8d62f50 HV	461	adap->monitor_pin_cnt--;
ca684386 HV	462	if (mode_follower == CEC_MODE_FOLLOWER)
ca684386 HV	463	adap->follower_cnt++;
b8d62f50	464	if (mode_follower == CEC_MODE_MONITOR_PIN) {
ea5c8ef2 HV	465	struct cec_event ev = {
	466	.flags = CEC_EVENT_FL_INITIAL_STATE,
	467	};
	468
28e11b15 HV	469	ev.event = adap->cec_pin_is_high ? CEC_EVENT_PIN_CEC_HIGH :
28e11b15 HV	470	CEC_EVENT_PIN_CEC_LOW;
ea5c8ef2	471	cec_queue_event_fh(fh, &ev, 0);
b8d62f50 HV	472	adap->monitor_pin_cnt++;
b8d62f50 HV	473	}
ca684386 HV	474	if (mode_follower == CEC_MODE_EXCL_FOLLOWER \|\|
	475	mode_follower == CEC_MODE_EXCL_FOLLOWER_PASSTHRU) {
	476	adap->passthrough =
	477	mode_follower == CEC_MODE_EXCL_FOLLOWER_PASSTHRU;
	478	adap->cec_follower = fh;
	479	} else if (adap->cec_follower == fh) {
	480	adap->passthrough = false;
	481	adap->cec_follower = NULL;
	482	}
	483	if (mode_initiator == CEC_MODE_EXCL_INITIATOR)
	484	adap->cec_initiator = fh;
	485	else if (adap->cec_initiator == fh)
	486	adap->cec_initiator = NULL;
	487	fh->mode_initiator = mode_initiator;
	488	fh->mode_follower = mode_follower;
	489	mutex_unlock(&adap->lock);
	490	return 0;
	491	}
	492
	493	static long cec_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
	494	{
	495	struct cec_devnode *devnode = cec_devnode_data(filp);
	496	struct cec_fh *fh = filp->private_data;
	497	struct cec_adapter *adap = fh->adap;
	498	bool block = !(filp->f_flags & O_NONBLOCK);
	499	void __user parg = (void __user )arg;
	500
	501	if (!devnode->registered)
60815d4a	502	return -ENODEV;
ca684386 HV	503
	504	switch (cmd) {
	505	case CEC_ADAP_G_CAPS:
	506	return cec_adap_g_caps(adap, parg);
	507
	508	case CEC_ADAP_G_PHYS_ADDR:
	509	return cec_adap_g_phys_addr(adap, parg);
	510
	511	case CEC_ADAP_S_PHYS_ADDR:
	512	return cec_adap_s_phys_addr(adap, fh, block, parg);
	513
	514	case CEC_ADAP_G_LOG_ADDRS:
	515	return cec_adap_g_log_addrs(adap, parg);
	516
	517	case CEC_ADAP_S_LOG_ADDRS:
	518	return cec_adap_s_log_addrs(adap, fh, block, parg);
	519
	520	case CEC_TRANSMIT:
	521	return cec_transmit(adap, fh, block, parg);
	522
	523	case CEC_RECEIVE:
	524	return cec_receive(adap, fh, block, parg);
	525
	526	case CEC_DQEVENT:
	527	return cec_dqevent(adap, fh, block, parg);
	528
	529	case CEC_G_MODE:
	530	return cec_g_mode(adap, fh, parg);
	531
	532	case CEC_S_MODE:
	533	return cec_s_mode(adap, fh, parg);
	534
	535	default:
	536	return -ENOTTY;
	537	}
	538	}
	539
	540	static int cec_open(struct inode inode, struct file filp)
	541	{
	542	struct cec_devnode *devnode =
	543	container_of(inode->i_cdev, struct cec_devnode, cdev);
	544	struct cec_adapter *adap = to_cec_adapter(devnode);
	545	struct cec_fh fh = kzalloc(sizeof(fh), GFP_KERNEL);
	546	/*
	547	* Initial events that are automatically sent when the cec device is
	548	* opened.
	549	*/
333ef6bd	550	struct cec_event ev = {
ca684386 HV	551	.event = CEC_EVENT_STATE_CHANGE,
	552	.flags = CEC_EVENT_FL_INITIAL_STATE,
	553	};
6b2bbb08	554	unsigned int i;
ca684386 HV	555	int err;
	556
	557	if (!fh)
	558	return -ENOMEM;
	559
	560	INIT_LIST_HEAD(&fh->msgs);
	561	INIT_LIST_HEAD(&fh->xfer_list);
6b2bbb08 HV	562	for (i = 0; i < CEC_NUM_EVENTS; i++)
6b2bbb08 HV	563	INIT_LIST_HEAD(&fh->events[i]);
ca684386 HV	564	mutex_init(&fh->lock);
	565	init_waitqueue_head(&fh->wait);
	566
	567	fh->mode_initiator = CEC_MODE_INITIATOR;
	568	fh->adap = adap;
	569
	570	err = cec_get_device(devnode);
	571	if (err) {
	572	kfree(fh);
	573	return err;
	574	}
	575
533a3f7b HV	576	mutex_lock(&devnode->lock);
533a3f7b HV	577	if (list_empty(&devnode->fhs) &&
f902c1e9	578	!adap->needs_hpd &&
533a3f7b HV	579	adap->phys_addr == CEC_PHYS_ADDR_INVALID) {
	580	err = adap->ops->adap_enable(adap, true);
	581	if (err) {
	582	mutex_unlock(&devnode->lock);
	583	kfree(fh);
	584	return err;
	585	}
	586	}
ca684386 HV	587	filp->private_data = fh;
ca684386 HV	588
ca684386	589	/* Queue up initial state events */
333ef6bd HV	590	ev.state_change.phys_addr = adap->phys_addr;
	591	ev.state_change.log_addr_mask = adap->log_addrs.log_addr_mask;
	592	cec_queue_event_fh(fh, &ev, 0);
	593	#ifdef CONFIG_CEC_PIN
	594	if (adap->pin && adap->pin->ops->read_hpd) {
	595	err = adap->pin->ops->read_hpd(adap);
	596	if (err >= 0) {
	597	ev.event = err ? CEC_EVENT_PIN_HPD_HIGH :
	598	CEC_EVENT_PIN_HPD_LOW;
	599	cec_queue_event_fh(fh, &ev, 0);
	600	}
	601	}
	602	#endif
ca684386 HV	603
ca684386 HV	604	list_add(&fh->list, &devnode->fhs);
62148f09	605	mutex_unlock(&devnode->lock);
ca684386 HV	606
	607	return 0;
	608	}
	609
	610	/* Override for the release function */
	611	static int cec_release(struct inode inode, struct file filp)
	612	{
	613	struct cec_devnode *devnode = cec_devnode_data(filp);
	614	struct cec_adapter *adap = to_cec_adapter(devnode);
	615	struct cec_fh *fh = filp->private_data;
6b2bbb08	616	unsigned int i;
ca684386 HV	617
	618	mutex_lock(&adap->lock);
	619	if (adap->cec_initiator == fh)
	620	adap->cec_initiator = NULL;
	621	if (adap->cec_follower == fh) {
	622	adap->cec_follower = NULL;
	623	adap->passthrough = false;
	624	}
	625	if (fh->mode_follower == CEC_MODE_FOLLOWER)
	626	adap->follower_cnt--;
b8d62f50 HV	627	if (fh->mode_follower == CEC_MODE_MONITOR_PIN)
b8d62f50 HV	628	adap->monitor_pin_cnt--;
ca684386 HV	629	if (fh->mode_follower == CEC_MODE_MONITOR_ALL)
	630	cec_monitor_all_cnt_dec(adap);
	631	mutex_unlock(&adap->lock);
	632
62148f09	633	mutex_lock(&devnode->lock);
ca684386	634	list_del(&fh->list);
533a3f7b	635	if (list_empty(&devnode->fhs) &&
f902c1e9	636	!adap->needs_hpd &&
533a3f7b HV	637	adap->phys_addr == CEC_PHYS_ADDR_INVALID) {
	638	WARN_ON(adap->ops->adap_enable(adap, false));
	639	}
62148f09	640	mutex_unlock(&devnode->lock);
ca684386 HV	641
	642	/* Unhook pending transmits from this filehandle. */
	643	mutex_lock(&adap->lock);
	644	while (!list_empty(&fh->xfer_list)) {
	645	struct cec_data *data =
	646	list_first_entry(&fh->xfer_list, struct cec_data, xfer_list);
	647
	648	data->blocking = false;
	649	data->fh = NULL;
	650	list_del(&data->xfer_list);
	651	}
	652	mutex_unlock(&adap->lock);
	653	while (!list_empty(&fh->msgs)) {
	654	struct cec_msg_entry *entry =
	655	list_first_entry(&fh->msgs, struct cec_msg_entry, list);
	656
	657	list_del(&entry->list);
	658	kfree(entry);
	659	}
6b2bbb08 HV	660	for (i = CEC_NUM_CORE_EVENTS; i < CEC_NUM_EVENTS; i++) {
	661	while (!list_empty(&fh->events[i])) {
	662	struct cec_event_entry *entry =
	663	list_first_entry(&fh->events[i],
	664	struct cec_event_entry, list);
	665
	666	list_del(&entry->list);
	667	kfree(entry);
	668	}
	669	}
ca684386 HV	670	kfree(fh);
	671
	672	cec_put_device(devnode);
	673	filp->private_data = NULL;
	674	return 0;
	675	}
	676
	677	const struct file_operations cec_devnode_fops = {
	678	.owner = THIS_MODULE,
	679	.open = cec_open,
	680	.unlocked_ioctl = cec_ioctl,
	681	.release = cec_release,
	682	.poll = cec_poll,
	683	.llseek = no_llseek,
	684	};