2018-02-07 22:34:03 +08:00
|
|
|
// SPDX-License-Identifier: GPL-2.0-only
|
2016-06-25 20:44:43 +08:00
|
|
|
/*
|
|
|
|
* cec-api.c - HDMI Consumer Electronics Control framework - API
|
|
|
|
*
|
|
|
|
* Copyright 2016 Cisco Systems, Inc. and/or its affiliates. All rights reserved.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#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>
|
|
|
|
|
2017-07-11 14:30:42 +08:00
|
|
|
#include <media/cec-pin.h>
|
2016-06-25 20:44:43 +08:00
|
|
|
#include "cec-priv.h"
|
2017-10-14 00:01:32 +08:00
|
|
|
#include "cec-pin-priv.h"
|
2016-06-25 20:44:43 +08:00
|
|
|
|
|
|
|
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 */
|
|
|
|
|
2017-07-03 15:02:56 +08:00
|
|
|
static __poll_t cec_poll(struct file *filp,
|
2016-06-25 20:44:43 +08:00
|
|
|
struct poll_table_struct *poll)
|
|
|
|
{
|
|
|
|
struct cec_fh *fh = filp->private_data;
|
|
|
|
struct cec_adapter *adap = fh->adap;
|
2017-07-03 15:02:56 +08:00
|
|
|
__poll_t res = 0;
|
2016-06-25 20:44:43 +08:00
|
|
|
|
2017-11-22 17:12:39 +08:00
|
|
|
if (!cec_is_registered(adap))
|
2018-02-12 06:34:03 +08:00
|
|
|
return EPOLLERR | EPOLLHUP;
|
2016-06-25 20:44:43 +08:00
|
|
|
mutex_lock(&adap->lock);
|
2016-07-18 00:02:44 +08:00
|
|
|
if (adap->is_configured &&
|
|
|
|
adap->transmit_queue_sz < CEC_MAX_MSG_TX_QUEUE_SZ)
|
2018-02-12 06:34:03 +08:00
|
|
|
res |= EPOLLOUT | EPOLLWRNORM;
|
2016-06-25 20:44:43 +08:00
|
|
|
if (fh->queued_msgs)
|
2018-02-12 06:34:03 +08:00
|
|
|
res |= EPOLLIN | EPOLLRDNORM;
|
2017-07-11 14:30:39 +08:00
|
|
|
if (fh->total_queued_events)
|
2018-02-12 06:34:03 +08:00
|
|
|
res |= EPOLLPRI;
|
2016-06-25 20:44:43 +08:00
|
|
|
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 = {};
|
|
|
|
|
2018-09-10 20:19:14 +08:00
|
|
|
strscpy(caps.driver, adap->devnode.dev.parent->driver->name,
|
2016-06-25 20:44:43 +08:00
|
|
|
sizeof(caps.driver));
|
2018-09-10 20:19:14 +08:00
|
|
|
strscpy(caps.name, adap->name, sizeof(caps.name));
|
2016-06-25 20:44:43 +08:00
|
|
|
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;
|
|
|
|
}
|
|
|
|
|
2018-09-13 15:36:29 +08:00
|
|
|
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;
|
|
|
|
}
|
|
|
|
|
2016-06-25 20:44:43 +08:00
|
|
|
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;
|
|
|
|
|
2018-09-13 15:36:29 +08:00
|
|
|
err = cec_validate_phys_addr(phys_addr);
|
2016-06-25 20:44:43 +08:00
|
|
|
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;
|
2016-11-01 17:59:34 +08:00
|
|
|
log_addrs.flags &= CEC_LOG_ADDRS_FL_ALLOW_UNREG_FALLBACK |
|
2016-11-02 17:41:41 +08:00
|
|
|
CEC_LOG_ADDRS_FL_ALLOW_RC_PASSTHRU |
|
|
|
|
CEC_LOG_ADDRS_FL_CDC_ONLY;
|
2016-06-25 20:44:43 +08:00
|
|
|
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;
|
2016-11-02 17:41:41 +08:00
|
|
|
|
|
|
|
/* 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;
|
|
|
|
|
2016-06-25 20:44:43 +08:00
|
|
|
mutex_lock(&adap->lock);
|
2017-02-27 20:18:35 +08:00
|
|
|
if (adap->log_addrs.num_log_addrs == 0)
|
|
|
|
err = -EPERM;
|
|
|
|
else if (adap->is_configuring)
|
2017-02-10 23:02:31 +08:00
|
|
|
err = -ENONET;
|
2017-06-07 22:46:12 +08:00
|
|
|
else if (!adap->is_configured &&
|
|
|
|
(adap->needs_hpd || msg.msg[0] != 0xf0))
|
2016-06-25 20:44:43 +08:00
|
|
|
err = -ENONET;
|
2016-07-16 20:59:18 +08:00
|
|
|
else if (cec_is_busy(adap, fh))
|
2016-06-25 20:44:43 +08:00
|
|
|
err = -EBUSY;
|
2016-07-16 20:59:18 +08:00
|
|
|
else
|
2016-06-25 20:44:43 +08:00
|
|
|
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)
|
|
|
|
{
|
2016-07-16 18:58:31 +08:00
|
|
|
u32 timeout = msg->timeout;
|
2016-06-25 20:44:43 +08:00
|
|
|
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);
|
2016-07-16 18:58:31 +08:00
|
|
|
/* restore original timeout value */
|
|
|
|
msg->timeout = timeout;
|
2016-06-25 20:44:43 +08:00
|
|
|
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 = {};
|
2017-06-07 23:07:51 +08:00
|
|
|
long err;
|
2016-06-25 20:44:43 +08:00
|
|
|
|
|
|
|
if (copy_from_user(&msg, parg, sizeof(msg)))
|
|
|
|
return -EFAULT;
|
|
|
|
|
|
|
|
err = cec_receive_msg(fh, &msg, block);
|
|
|
|
if (err)
|
|
|
|
return err;
|
2016-11-04 17:52:11 +08:00
|
|
|
msg.flags = 0;
|
2016-06-25 20:44:43 +08:00
|
|
|
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)
|
|
|
|
{
|
2017-07-11 14:30:39 +08:00
|
|
|
struct cec_event_entry *ev = NULL;
|
2016-06-25 20:44:43 +08:00
|
|
|
u64 ts = ~0ULL;
|
|
|
|
unsigned int i;
|
2017-07-11 14:30:39 +08:00
|
|
|
unsigned int ev_idx;
|
2016-06-25 20:44:43 +08:00
|
|
|
long err = 0;
|
|
|
|
|
|
|
|
mutex_lock(&fh->lock);
|
2017-07-11 14:30:39 +08:00
|
|
|
while (!fh->total_queued_events && block) {
|
2016-06-25 20:44:43 +08:00
|
|
|
mutex_unlock(&fh->lock);
|
2017-07-11 14:30:39 +08:00
|
|
|
err = wait_event_interruptible(fh->wait,
|
|
|
|
fh->total_queued_events);
|
2016-06-25 20:44:43 +08:00
|
|
|
if (err)
|
|
|
|
return err;
|
|
|
|
mutex_lock(&fh->lock);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Find the oldest event */
|
|
|
|
for (i = 0; i < CEC_NUM_EVENTS; i++) {
|
2017-07-11 14:30:39 +08:00
|
|
|
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;
|
2016-06-25 20:44:43 +08:00
|
|
|
}
|
|
|
|
}
|
2017-07-11 14:30:39 +08:00
|
|
|
|
2016-06-25 20:44:43 +08:00
|
|
|
if (!ev) {
|
|
|
|
err = -EAGAIN;
|
|
|
|
goto unlock;
|
|
|
|
}
|
2017-07-11 14:30:39 +08:00
|
|
|
list_del(&ev->list);
|
2016-06-25 20:44:43 +08:00
|
|
|
|
2017-07-11 14:30:39 +08:00
|
|
|
if (copy_to_user(parg, &ev->ev, sizeof(ev->ev)))
|
2016-06-25 20:44:43 +08:00
|
|
|
err = -EFAULT;
|
2017-07-11 14:30:39 +08:00
|
|
|
if (ev_idx >= CEC_NUM_CORE_EVENTS)
|
|
|
|
kfree(ev);
|
|
|
|
fh->queued_events[ev_idx]--;
|
|
|
|
fh->total_queued_events--;
|
2016-06-25 20:44:43 +08:00
|
|
|
|
|
|
|
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;
|
2017-11-05 20:36:36 +08:00
|
|
|
bool send_pin_event = false;
|
2016-06-25 20:44:43 +08:00
|
|
|
long err = 0;
|
|
|
|
|
|
|
|
if (copy_from_user(&mode, parg, sizeof(mode)))
|
|
|
|
return -EFAULT;
|
2017-08-06 19:04:05 +08:00
|
|
|
if (mode & ~(CEC_MODE_INITIATOR_MSK | CEC_MODE_FOLLOWER_MSK)) {
|
|
|
|
dprintk(1, "%s: invalid mode bits set\n", __func__);
|
2016-06-25 20:44:43 +08:00
|
|
|
return -EINVAL;
|
2017-08-06 19:04:05 +08:00
|
|
|
}
|
2016-06-25 20:44:43 +08:00
|
|
|
|
|
|
|
mode_initiator = mode & CEC_MODE_INITIATOR_MSK;
|
|
|
|
mode_follower = mode & CEC_MODE_FOLLOWER_MSK;
|
|
|
|
|
|
|
|
if (mode_initiator > CEC_MODE_EXCL_INITIATOR ||
|
2017-08-06 19:04:05 +08:00
|
|
|
mode_follower > CEC_MODE_MONITOR_ALL) {
|
|
|
|
dprintk(1, "%s: unknown mode\n", __func__);
|
2016-06-25 20:44:43 +08:00
|
|
|
return -EINVAL;
|
2017-08-06 19:04:05 +08:00
|
|
|
}
|
2016-06-25 20:44:43 +08:00
|
|
|
|
|
|
|
if (mode_follower == CEC_MODE_MONITOR_ALL &&
|
2017-08-06 19:04:05 +08:00
|
|
|
!(adap->capabilities & CEC_CAP_MONITOR_ALL)) {
|
|
|
|
dprintk(1, "%s: MONITOR_ALL not supported\n", __func__);
|
2016-06-25 20:44:43 +08:00
|
|
|
return -EINVAL;
|
2017-08-06 19:04:05 +08:00
|
|
|
}
|
2016-06-25 20:44:43 +08:00
|
|
|
|
2017-07-11 14:30:41 +08:00
|
|
|
if (mode_follower == CEC_MODE_MONITOR_PIN &&
|
2017-08-06 19:04:05 +08:00
|
|
|
!(adap->capabilities & CEC_CAP_MONITOR_PIN)) {
|
|
|
|
dprintk(1, "%s: MONITOR_PIN not supported\n", __func__);
|
2017-07-11 14:30:41 +08:00
|
|
|
return -EINVAL;
|
2017-08-06 19:04:05 +08:00
|
|
|
}
|
2017-07-11 14:30:41 +08:00
|
|
|
|
2016-06-25 20:44:43 +08:00
|
|
|
/* 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 &&
|
2017-08-06 19:04:05 +08:00
|
|
|
mode_follower <= CEC_MODE_EXCL_FOLLOWER_PASSTHRU) {
|
|
|
|
dprintk(1, "%s: cannot transmit\n", __func__);
|
2016-06-25 20:44:43 +08:00
|
|
|
return -EINVAL;
|
2017-08-06 19:04:05 +08:00
|
|
|
}
|
2016-06-25 20:44:43 +08:00
|
|
|
|
|
|
|
/* Monitor modes require CEC_MODE_NO_INITIATOR */
|
2017-08-06 19:04:05 +08:00
|
|
|
if (mode_initiator && mode_follower >= CEC_MODE_MONITOR_PIN) {
|
|
|
|
dprintk(1, "%s: monitor modes require NO_INITIATOR\n",
|
|
|
|
__func__);
|
2016-06-25 20:44:43 +08:00
|
|
|
return -EINVAL;
|
2017-08-06 19:04:05 +08:00
|
|
|
}
|
2016-06-25 20:44:43 +08:00
|
|
|
|
|
|
|
/* Monitor modes require CAP_NET_ADMIN */
|
2017-07-11 14:30:41 +08:00
|
|
|
if (mode_follower >= CEC_MODE_MONITOR_PIN && !capable(CAP_NET_ADMIN))
|
2016-06-25 20:44:43 +08:00
|
|
|
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);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-11-05 20:36:36 +08:00
|
|
|
if (!err) {
|
|
|
|
bool old_mon_pin = fh->mode_follower == CEC_MODE_MONITOR_PIN;
|
|
|
|
bool new_mon_pin = mode_follower == CEC_MODE_MONITOR_PIN;
|
|
|
|
|
|
|
|
if (old_mon_pin != new_mon_pin) {
|
|
|
|
send_pin_event = new_mon_pin;
|
|
|
|
if (new_mon_pin)
|
|
|
|
err = cec_monitor_pin_cnt_inc(adap);
|
|
|
|
else
|
|
|
|
cec_monitor_pin_cnt_dec(adap);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2016-06-25 20:44:43 +08:00
|
|
|
if (err) {
|
|
|
|
mutex_unlock(&adap->lock);
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (fh->mode_follower == CEC_MODE_FOLLOWER)
|
|
|
|
adap->follower_cnt--;
|
|
|
|
if (mode_follower == CEC_MODE_FOLLOWER)
|
|
|
|
adap->follower_cnt++;
|
2017-11-05 20:36:36 +08:00
|
|
|
if (send_pin_event) {
|
2017-07-11 14:30:42 +08:00
|
|
|
struct cec_event ev = {
|
|
|
|
.flags = CEC_EVENT_FL_INITIAL_STATE,
|
|
|
|
};
|
|
|
|
|
2017-08-20 18:53:10 +08:00
|
|
|
ev.event = adap->cec_pin_is_high ? CEC_EVENT_PIN_CEC_HIGH :
|
|
|
|
CEC_EVENT_PIN_CEC_LOW;
|
2017-07-11 14:30:42 +08:00
|
|
|
cec_queue_event_fh(fh, &ev, 0);
|
2017-07-11 14:30:41 +08:00
|
|
|
}
|
2016-06-25 20:44:43 +08:00
|
|
|
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_fh *fh = filp->private_data;
|
|
|
|
struct cec_adapter *adap = fh->adap;
|
|
|
|
bool block = !(filp->f_flags & O_NONBLOCK);
|
|
|
|
void __user *parg = (void __user *)arg;
|
|
|
|
|
2017-11-22 17:12:39 +08:00
|
|
|
if (!cec_is_registered(adap))
|
2016-08-24 18:17:22 +08:00
|
|
|
return -ENODEV;
|
2016-06-25 20:44:43 +08:00
|
|
|
|
|
|
|
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.
|
|
|
|
*/
|
2017-08-15 22:07:25 +08:00
|
|
|
struct cec_event ev = {
|
2016-06-25 20:44:43 +08:00
|
|
|
.event = CEC_EVENT_STATE_CHANGE,
|
|
|
|
.flags = CEC_EVENT_FL_INITIAL_STATE,
|
|
|
|
};
|
2017-07-11 14:30:39 +08:00
|
|
|
unsigned int i;
|
2016-06-25 20:44:43 +08:00
|
|
|
int err;
|
|
|
|
|
|
|
|
if (!fh)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
INIT_LIST_HEAD(&fh->msgs);
|
|
|
|
INIT_LIST_HEAD(&fh->xfer_list);
|
2017-07-11 14:30:39 +08:00
|
|
|
for (i = 0; i < CEC_NUM_EVENTS; i++)
|
|
|
|
INIT_LIST_HEAD(&fh->events[i]);
|
2016-06-25 20:44:43 +08:00
|
|
|
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;
|
|
|
|
}
|
|
|
|
|
2017-02-10 23:02:31 +08:00
|
|
|
mutex_lock(&devnode->lock);
|
|
|
|
if (list_empty(&devnode->fhs) &&
|
2017-06-07 22:46:12 +08:00
|
|
|
!adap->needs_hpd &&
|
2017-02-10 23:02:31 +08:00
|
|
|
adap->phys_addr == CEC_PHYS_ADDR_INVALID) {
|
|
|
|
err = adap->ops->adap_enable(adap, true);
|
|
|
|
if (err) {
|
|
|
|
mutex_unlock(&devnode->lock);
|
|
|
|
kfree(fh);
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
}
|
2016-06-25 20:44:43 +08:00
|
|
|
filp->private_data = fh;
|
|
|
|
|
|
|
|
/* Queue up initial state events */
|
2017-08-15 22:07:25 +08:00
|
|
|
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);
|
|
|
|
}
|
|
|
|
}
|
2018-06-28 19:43:46 +08:00
|
|
|
if (adap->pin && adap->pin->ops->read_5v) {
|
|
|
|
err = adap->pin->ops->read_5v(adap);
|
|
|
|
if (err >= 0) {
|
|
|
|
ev.event = err ? CEC_EVENT_PIN_5V_HIGH :
|
|
|
|
CEC_EVENT_PIN_5V_LOW;
|
|
|
|
cec_queue_event_fh(fh, &ev, 0);
|
|
|
|
}
|
|
|
|
}
|
2017-08-15 22:07:25 +08:00
|
|
|
#endif
|
2016-06-25 20:44:43 +08:00
|
|
|
|
|
|
|
list_add(&fh->list, &devnode->fhs);
|
2016-08-02 19:11:00 +08:00
|
|
|
mutex_unlock(&devnode->lock);
|
2016-06-25 20:44:43 +08:00
|
|
|
|
|
|
|
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;
|
2017-07-11 14:30:39 +08:00
|
|
|
unsigned int i;
|
2016-06-25 20:44:43 +08:00
|
|
|
|
|
|
|
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--;
|
2017-07-11 14:30:41 +08:00
|
|
|
if (fh->mode_follower == CEC_MODE_MONITOR_PIN)
|
2017-11-05 20:36:36 +08:00
|
|
|
cec_monitor_pin_cnt_dec(adap);
|
2016-06-25 20:44:43 +08:00
|
|
|
if (fh->mode_follower == CEC_MODE_MONITOR_ALL)
|
|
|
|
cec_monitor_all_cnt_dec(adap);
|
|
|
|
mutex_unlock(&adap->lock);
|
|
|
|
|
2016-08-02 19:11:00 +08:00
|
|
|
mutex_lock(&devnode->lock);
|
2016-06-25 20:44:43 +08:00
|
|
|
list_del(&fh->list);
|
2017-11-22 17:12:39 +08:00
|
|
|
if (cec_is_registered(adap) && list_empty(&devnode->fhs) &&
|
|
|
|
!adap->needs_hpd && adap->phys_addr == CEC_PHYS_ADDR_INVALID) {
|
2017-02-10 23:02:31 +08:00
|
|
|
WARN_ON(adap->ops->adap_enable(adap, false));
|
|
|
|
}
|
2016-08-02 19:11:00 +08:00
|
|
|
mutex_unlock(&devnode->lock);
|
2016-06-25 20:44:43 +08:00
|
|
|
|
|
|
|
/* 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);
|
|
|
|
}
|
2017-07-11 14:30:39 +08:00
|
|
|
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);
|
|
|
|
}
|
|
|
|
}
|
2016-06-25 20:44:43 +08:00
|
|
|
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,
|
2018-08-28 03:56:23 +08:00
|
|
|
.compat_ioctl = cec_ioctl,
|
2016-06-25 20:44:43 +08:00
|
|
|
.release = cec_release,
|
|
|
|
.poll = cec_poll,
|
|
|
|
.llseek = no_llseek,
|
|
|
|
};
|