767 lines
20 KiB
C
767 lines
20 KiB
C
|
/*
|
||
|
* Pulse Eight HDMI CEC driver
|
||
|
*
|
||
|
* Copyright 2016 Hans Verkuil <hverkuil@xs4all.nl
|
||
|
*
|
||
|
* This program is free software; you can redistribute it and/or modify it
|
||
|
* under the terms of the GNU General Public License as published by the
|
||
|
* Free Software Foundation; either version of 2 of the License, or (at your
|
||
|
* option) any later version. See the file COPYING in the main directory of
|
||
|
* this archive for more details.
|
||
|
*/
|
||
|
|
||
|
/*
|
||
|
* Notes:
|
||
|
*
|
||
|
* - Devices with firmware version < 2 do not store their configuration in
|
||
|
* EEPROM.
|
||
|
*
|
||
|
* - In autonomous mode, only messages from a TV will be acknowledged, even
|
||
|
* polling messages. Upon receiving a message from a TV, the dongle will
|
||
|
* respond to messages from any logical address.
|
||
|
*
|
||
|
* - In autonomous mode, the dongle will by default reply Feature Abort
|
||
|
* [Unrecognized Opcode] when it receives Give Device Vendor ID. It will
|
||
|
* however observe vendor ID's reported by other devices and possibly
|
||
|
* alter this behavior. When TV's (and TV's only) report that their vendor ID
|
||
|
* is LG (0x00e091), the dongle will itself reply that it has the same vendor
|
||
|
* ID, and it will respond to at least one vendor specific command.
|
||
|
*
|
||
|
* - In autonomous mode, the dongle is known to attempt wakeup if it receives
|
||
|
* <User Control Pressed> ["Power On"], ["Power] or ["Power Toggle"], or if it
|
||
|
* receives <Set Stream Path> with its own physical address. It also does this
|
||
|
* if it receives <Vendor Specific Command> [0x03 0x00] from an LG TV.
|
||
|
*/
|
||
|
|
||
|
#include <linux/completion.h>
|
||
|
#include <linux/init.h>
|
||
|
#include <linux/interrupt.h>
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/workqueue.h>
|
||
|
#include <linux/serio.h>
|
||
|
#include <linux/slab.h>
|
||
|
#include <linux/time.h>
|
||
|
#include <linux/delay.h>
|
||
|
|
||
|
#include <media/cec.h>
|
||
|
|
||
|
MODULE_AUTHOR("Hans Verkuil <hverkuil@xs4all.nl>");
|
||
|
MODULE_DESCRIPTION("Pulse Eight HDMI CEC driver");
|
||
|
MODULE_LICENSE("GPL");
|
||
|
|
||
|
static int debug;
|
||
|
static int persistent_config;
|
||
|
module_param(debug, int, 0644);
|
||
|
module_param(persistent_config, int, 0644);
|
||
|
MODULE_PARM_DESC(debug, "debug level (0-1)");
|
||
|
MODULE_PARM_DESC(persistent_config, "read config from persistent memory (0-1)");
|
||
|
|
||
|
enum pulse8_msgcodes {
|
||
|
MSGCODE_NOTHING = 0,
|
||
|
MSGCODE_PING,
|
||
|
MSGCODE_TIMEOUT_ERROR,
|
||
|
MSGCODE_HIGH_ERROR,
|
||
|
MSGCODE_LOW_ERROR,
|
||
|
MSGCODE_FRAME_START,
|
||
|
MSGCODE_FRAME_DATA,
|
||
|
MSGCODE_RECEIVE_FAILED,
|
||
|
MSGCODE_COMMAND_ACCEPTED, /* 0x08 */
|
||
|
MSGCODE_COMMAND_REJECTED,
|
||
|
MSGCODE_SET_ACK_MASK,
|
||
|
MSGCODE_TRANSMIT,
|
||
|
MSGCODE_TRANSMIT_EOM,
|
||
|
MSGCODE_TRANSMIT_IDLETIME,
|
||
|
MSGCODE_TRANSMIT_ACK_POLARITY,
|
||
|
MSGCODE_TRANSMIT_LINE_TIMEOUT,
|
||
|
MSGCODE_TRANSMIT_SUCCEEDED, /* 0x10 */
|
||
|
MSGCODE_TRANSMIT_FAILED_LINE,
|
||
|
MSGCODE_TRANSMIT_FAILED_ACK,
|
||
|
MSGCODE_TRANSMIT_FAILED_TIMEOUT_DATA,
|
||
|
MSGCODE_TRANSMIT_FAILED_TIMEOUT_LINE,
|
||
|
MSGCODE_FIRMWARE_VERSION,
|
||
|
MSGCODE_START_BOOTLOADER,
|
||
|
MSGCODE_GET_BUILDDATE,
|
||
|
MSGCODE_SET_CONTROLLED, /* 0x18 */
|
||
|
MSGCODE_GET_AUTO_ENABLED,
|
||
|
MSGCODE_SET_AUTO_ENABLED,
|
||
|
MSGCODE_GET_DEFAULT_LOGICAL_ADDRESS,
|
||
|
MSGCODE_SET_DEFAULT_LOGICAL_ADDRESS,
|
||
|
MSGCODE_GET_LOGICAL_ADDRESS_MASK,
|
||
|
MSGCODE_SET_LOGICAL_ADDRESS_MASK,
|
||
|
MSGCODE_GET_PHYSICAL_ADDRESS,
|
||
|
MSGCODE_SET_PHYSICAL_ADDRESS, /* 0x20 */
|
||
|
MSGCODE_GET_DEVICE_TYPE,
|
||
|
MSGCODE_SET_DEVICE_TYPE,
|
||
|
MSGCODE_GET_HDMI_VERSION,
|
||
|
MSGCODE_SET_HDMI_VERSION,
|
||
|
MSGCODE_GET_OSD_NAME,
|
||
|
MSGCODE_SET_OSD_NAME,
|
||
|
MSGCODE_WRITE_EEPROM,
|
||
|
MSGCODE_GET_ADAPTER_TYPE, /* 0x28 */
|
||
|
MSGCODE_SET_ACTIVE_SOURCE,
|
||
|
|
||
|
MSGCODE_FRAME_EOM = 0x80,
|
||
|
MSGCODE_FRAME_ACK = 0x40,
|
||
|
};
|
||
|
|
||
|
#define MSGSTART 0xff
|
||
|
#define MSGEND 0xfe
|
||
|
#define MSGESC 0xfd
|
||
|
#define MSGOFFSET 3
|
||
|
|
||
|
#define DATA_SIZE 256
|
||
|
|
||
|
#define PING_PERIOD (15 * HZ)
|
||
|
|
||
|
struct pulse8 {
|
||
|
struct device *dev;
|
||
|
struct serio *serio;
|
||
|
struct cec_adapter *adap;
|
||
|
unsigned int vers;
|
||
|
struct completion cmd_done;
|
||
|
struct work_struct work;
|
||
|
u8 work_result;
|
||
|
struct delayed_work ping_eeprom_work;
|
||
|
struct cec_msg rx_msg;
|
||
|
u8 data[DATA_SIZE];
|
||
|
unsigned int len;
|
||
|
u8 buf[DATA_SIZE];
|
||
|
unsigned int idx;
|
||
|
bool escape;
|
||
|
bool started;
|
||
|
struct mutex config_lock;
|
||
|
struct mutex write_lock;
|
||
|
bool config_pending;
|
||
|
bool restoring_config;
|
||
|
bool autonomous;
|
||
|
};
|
||
|
|
||
|
static void pulse8_ping_eeprom_work_handler(struct work_struct *work);
|
||
|
|
||
|
static void pulse8_irq_work_handler(struct work_struct *work)
|
||
|
{
|
||
|
struct pulse8 *pulse8 =
|
||
|
container_of(work, struct pulse8, work);
|
||
|
u8 result = pulse8->work_result;
|
||
|
|
||
|
pulse8->work_result = 0;
|
||
|
switch (result & 0x3f) {
|
||
|
case MSGCODE_FRAME_DATA:
|
||
|
cec_received_msg(pulse8->adap, &pulse8->rx_msg);
|
||
|
break;
|
||
|
case MSGCODE_TRANSMIT_SUCCEEDED:
|
||
|
cec_transmit_attempt_done(pulse8->adap, CEC_TX_STATUS_OK);
|
||
|
break;
|
||
|
case MSGCODE_TRANSMIT_FAILED_ACK:
|
||
|
cec_transmit_attempt_done(pulse8->adap, CEC_TX_STATUS_NACK);
|
||
|
break;
|
||
|
case MSGCODE_TRANSMIT_FAILED_LINE:
|
||
|
case MSGCODE_TRANSMIT_FAILED_TIMEOUT_DATA:
|
||
|
case MSGCODE_TRANSMIT_FAILED_TIMEOUT_LINE:
|
||
|
cec_transmit_attempt_done(pulse8->adap, CEC_TX_STATUS_ERROR);
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static irqreturn_t pulse8_interrupt(struct serio *serio, unsigned char data,
|
||
|
unsigned int flags)
|
||
|
{
|
||
|
struct pulse8 *pulse8 = serio_get_drvdata(serio);
|
||
|
|
||
|
if (!pulse8->started && data != MSGSTART)
|
||
|
return IRQ_HANDLED;
|
||
|
if (data == MSGESC) {
|
||
|
pulse8->escape = true;
|
||
|
return IRQ_HANDLED;
|
||
|
}
|
||
|
if (pulse8->escape) {
|
||
|
data += MSGOFFSET;
|
||
|
pulse8->escape = false;
|
||
|
} else if (data == MSGEND) {
|
||
|
struct cec_msg *msg = &pulse8->rx_msg;
|
||
|
u8 msgcode = pulse8->buf[0];
|
||
|
|
||
|
if (debug)
|
||
|
dev_info(pulse8->dev, "received: %*ph\n",
|
||
|
pulse8->idx, pulse8->buf);
|
||
|
switch (msgcode & 0x3f) {
|
||
|
case MSGCODE_FRAME_START:
|
||
|
msg->len = 1;
|
||
|
msg->msg[0] = pulse8->buf[1];
|
||
|
break;
|
||
|
case MSGCODE_FRAME_DATA:
|
||
|
if (msg->len == CEC_MAX_MSG_SIZE)
|
||
|
break;
|
||
|
msg->msg[msg->len++] = pulse8->buf[1];
|
||
|
if (msgcode & MSGCODE_FRAME_EOM) {
|
||
|
WARN_ON(pulse8->work_result);
|
||
|
pulse8->work_result = msgcode;
|
||
|
schedule_work(&pulse8->work);
|
||
|
break;
|
||
|
}
|
||
|
break;
|
||
|
case MSGCODE_TRANSMIT_SUCCEEDED:
|
||
|
case MSGCODE_TRANSMIT_FAILED_LINE:
|
||
|
case MSGCODE_TRANSMIT_FAILED_ACK:
|
||
|
case MSGCODE_TRANSMIT_FAILED_TIMEOUT_DATA:
|
||
|
case MSGCODE_TRANSMIT_FAILED_TIMEOUT_LINE:
|
||
|
WARN_ON(pulse8->work_result);
|
||
|
pulse8->work_result = msgcode;
|
||
|
schedule_work(&pulse8->work);
|
||
|
break;
|
||
|
case MSGCODE_HIGH_ERROR:
|
||
|
case MSGCODE_LOW_ERROR:
|
||
|
case MSGCODE_RECEIVE_FAILED:
|
||
|
case MSGCODE_TIMEOUT_ERROR:
|
||
|
break;
|
||
|
case MSGCODE_COMMAND_ACCEPTED:
|
||
|
case MSGCODE_COMMAND_REJECTED:
|
||
|
default:
|
||
|
if (pulse8->idx == 0)
|
||
|
break;
|
||
|
memcpy(pulse8->data, pulse8->buf, pulse8->idx);
|
||
|
pulse8->len = pulse8->idx;
|
||
|
complete(&pulse8->cmd_done);
|
||
|
break;
|
||
|
}
|
||
|
pulse8->idx = 0;
|
||
|
pulse8->started = false;
|
||
|
return IRQ_HANDLED;
|
||
|
} else if (data == MSGSTART) {
|
||
|
pulse8->idx = 0;
|
||
|
pulse8->started = true;
|
||
|
return IRQ_HANDLED;
|
||
|
}
|
||
|
|
||
|
if (pulse8->idx >= DATA_SIZE) {
|
||
|
dev_dbg(pulse8->dev,
|
||
|
"throwing away %d bytes of garbage\n", pulse8->idx);
|
||
|
pulse8->idx = 0;
|
||
|
}
|
||
|
pulse8->buf[pulse8->idx++] = data;
|
||
|
return IRQ_HANDLED;
|
||
|
}
|
||
|
|
||
|
static void pulse8_disconnect(struct serio *serio)
|
||
|
{
|
||
|
struct pulse8 *pulse8 = serio_get_drvdata(serio);
|
||
|
|
||
|
cec_unregister_adapter(pulse8->adap);
|
||
|
cancel_delayed_work_sync(&pulse8->ping_eeprom_work);
|
||
|
dev_info(&serio->dev, "disconnected\n");
|
||
|
serio_close(serio);
|
||
|
serio_set_drvdata(serio, NULL);
|
||
|
kfree(pulse8);
|
||
|
}
|
||
|
|
||
|
static int pulse8_send(struct serio *serio, const u8 *command, u8 cmd_len)
|
||
|
{
|
||
|
int err = 0;
|
||
|
|
||
|
err = serio_write(serio, MSGSTART);
|
||
|
if (err)
|
||
|
return err;
|
||
|
for (; !err && cmd_len; command++, cmd_len--) {
|
||
|
if (*command >= MSGESC) {
|
||
|
err = serio_write(serio, MSGESC);
|
||
|
if (!err)
|
||
|
err = serio_write(serio, *command - MSGOFFSET);
|
||
|
} else {
|
||
|
err = serio_write(serio, *command);
|
||
|
}
|
||
|
}
|
||
|
if (!err)
|
||
|
err = serio_write(serio, MSGEND);
|
||
|
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
static int pulse8_send_and_wait_once(struct pulse8 *pulse8,
|
||
|
const u8 *cmd, u8 cmd_len,
|
||
|
u8 response, u8 size)
|
||
|
{
|
||
|
int err;
|
||
|
|
||
|
/*dev_info(pulse8->dev, "transmit: %*ph\n", cmd_len, cmd);*/
|
||
|
init_completion(&pulse8->cmd_done);
|
||
|
|
||
|
err = pulse8_send(pulse8->serio, cmd, cmd_len);
|
||
|
if (err)
|
||
|
return err;
|
||
|
|
||
|
if (!wait_for_completion_timeout(&pulse8->cmd_done, HZ))
|
||
|
return -ETIMEDOUT;
|
||
|
if ((pulse8->data[0] & 0x3f) == MSGCODE_COMMAND_REJECTED &&
|
||
|
cmd[0] != MSGCODE_SET_CONTROLLED &&
|
||
|
cmd[0] != MSGCODE_SET_AUTO_ENABLED &&
|
||
|
cmd[0] != MSGCODE_GET_BUILDDATE)
|
||
|
return -ENOTTY;
|
||
|
if (response &&
|
||
|
((pulse8->data[0] & 0x3f) != response || pulse8->len < size + 1)) {
|
||
|
dev_info(pulse8->dev, "transmit: failed %02x\n",
|
||
|
pulse8->data[0] & 0x3f);
|
||
|
return -EIO;
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int pulse8_send_and_wait(struct pulse8 *pulse8,
|
||
|
const u8 *cmd, u8 cmd_len, u8 response, u8 size)
|
||
|
{
|
||
|
u8 cmd_sc[2];
|
||
|
int err;
|
||
|
|
||
|
mutex_lock(&pulse8->write_lock);
|
||
|
err = pulse8_send_and_wait_once(pulse8, cmd, cmd_len, response, size);
|
||
|
|
||
|
if (err == -ENOTTY) {
|
||
|
cmd_sc[0] = MSGCODE_SET_CONTROLLED;
|
||
|
cmd_sc[1] = 1;
|
||
|
err = pulse8_send_and_wait_once(pulse8, cmd_sc, 2,
|
||
|
MSGCODE_COMMAND_ACCEPTED, 1);
|
||
|
if (err)
|
||
|
goto unlock;
|
||
|
err = pulse8_send_and_wait_once(pulse8, cmd, cmd_len,
|
||
|
response, size);
|
||
|
}
|
||
|
|
||
|
unlock:
|
||
|
mutex_unlock(&pulse8->write_lock);
|
||
|
return err == -ENOTTY ? -EIO : err;
|
||
|
}
|
||
|
|
||
|
static int pulse8_setup(struct pulse8 *pulse8, struct serio *serio,
|
||
|
struct cec_log_addrs *log_addrs, u16 *pa)
|
||
|
{
|
||
|
u8 *data = pulse8->data + 1;
|
||
|
u8 cmd[2];
|
||
|
int err;
|
||
|
struct tm tm;
|
||
|
time64_t date;
|
||
|
|
||
|
pulse8->vers = 0;
|
||
|
|
||
|
cmd[0] = MSGCODE_FIRMWARE_VERSION;
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 1, cmd[0], 2);
|
||
|
if (err)
|
||
|
return err;
|
||
|
pulse8->vers = (data[0] << 8) | data[1];
|
||
|
dev_info(pulse8->dev, "Firmware version %04x\n", pulse8->vers);
|
||
|
if (pulse8->vers < 2) {
|
||
|
*pa = CEC_PHYS_ADDR_INVALID;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
cmd[0] = MSGCODE_GET_BUILDDATE;
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 1, cmd[0], 4);
|
||
|
if (err)
|
||
|
return err;
|
||
|
date = (data[0] << 24) | (data[1] << 16) | (data[2] << 8) | data[3];
|
||
|
time64_to_tm(date, 0, &tm);
|
||
|
dev_info(pulse8->dev, "Firmware build date %04ld.%02d.%02d %02d:%02d:%02d\n",
|
||
|
tm.tm_year + 1900, tm.tm_mon + 1, tm.tm_mday,
|
||
|
tm.tm_hour, tm.tm_min, tm.tm_sec);
|
||
|
|
||
|
dev_dbg(pulse8->dev, "Persistent config:\n");
|
||
|
cmd[0] = MSGCODE_GET_AUTO_ENABLED;
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 1, cmd[0], 1);
|
||
|
if (err)
|
||
|
return err;
|
||
|
pulse8->autonomous = data[0];
|
||
|
dev_dbg(pulse8->dev, "Autonomous mode: %s",
|
||
|
data[0] ? "on" : "off");
|
||
|
|
||
|
cmd[0] = MSGCODE_GET_DEVICE_TYPE;
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 1, cmd[0], 1);
|
||
|
if (err)
|
||
|
return err;
|
||
|
log_addrs->primary_device_type[0] = data[0];
|
||
|
dev_dbg(pulse8->dev, "Primary device type: %d\n", data[0]);
|
||
|
switch (log_addrs->primary_device_type[0]) {
|
||
|
case CEC_OP_PRIM_DEVTYPE_TV:
|
||
|
log_addrs->log_addr_type[0] = CEC_LOG_ADDR_TYPE_TV;
|
||
|
log_addrs->all_device_types[0] = CEC_OP_ALL_DEVTYPE_TV;
|
||
|
break;
|
||
|
case CEC_OP_PRIM_DEVTYPE_RECORD:
|
||
|
log_addrs->log_addr_type[0] = CEC_LOG_ADDR_TYPE_RECORD;
|
||
|
log_addrs->all_device_types[0] = CEC_OP_ALL_DEVTYPE_RECORD;
|
||
|
break;
|
||
|
case CEC_OP_PRIM_DEVTYPE_TUNER:
|
||
|
log_addrs->log_addr_type[0] = CEC_LOG_ADDR_TYPE_TUNER;
|
||
|
log_addrs->all_device_types[0] = CEC_OP_ALL_DEVTYPE_TUNER;
|
||
|
break;
|
||
|
case CEC_OP_PRIM_DEVTYPE_PLAYBACK:
|
||
|
log_addrs->log_addr_type[0] = CEC_LOG_ADDR_TYPE_PLAYBACK;
|
||
|
log_addrs->all_device_types[0] = CEC_OP_ALL_DEVTYPE_PLAYBACK;
|
||
|
break;
|
||
|
case CEC_OP_PRIM_DEVTYPE_AUDIOSYSTEM:
|
||
|
log_addrs->log_addr_type[0] = CEC_LOG_ADDR_TYPE_PLAYBACK;
|
||
|
log_addrs->all_device_types[0] = CEC_OP_ALL_DEVTYPE_AUDIOSYSTEM;
|
||
|
break;
|
||
|
case CEC_OP_PRIM_DEVTYPE_SWITCH:
|
||
|
log_addrs->log_addr_type[0] = CEC_LOG_ADDR_TYPE_UNREGISTERED;
|
||
|
log_addrs->all_device_types[0] = CEC_OP_ALL_DEVTYPE_SWITCH;
|
||
|
break;
|
||
|
case CEC_OP_PRIM_DEVTYPE_PROCESSOR:
|
||
|
log_addrs->log_addr_type[0] = CEC_LOG_ADDR_TYPE_SPECIFIC;
|
||
|
log_addrs->all_device_types[0] = CEC_OP_ALL_DEVTYPE_SWITCH;
|
||
|
break;
|
||
|
default:
|
||
|
log_addrs->log_addr_type[0] = CEC_LOG_ADDR_TYPE_UNREGISTERED;
|
||
|
log_addrs->all_device_types[0] = CEC_OP_ALL_DEVTYPE_SWITCH;
|
||
|
dev_info(pulse8->dev, "Unknown Primary Device Type: %d\n",
|
||
|
log_addrs->primary_device_type[0]);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
cmd[0] = MSGCODE_GET_LOGICAL_ADDRESS_MASK;
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 1, cmd[0], 2);
|
||
|
if (err)
|
||
|
return err;
|
||
|
log_addrs->log_addr_mask = (data[0] << 8) | data[1];
|
||
|
dev_dbg(pulse8->dev, "Logical address ACK mask: %x\n",
|
||
|
log_addrs->log_addr_mask);
|
||
|
if (log_addrs->log_addr_mask)
|
||
|
log_addrs->num_log_addrs = 1;
|
||
|
|
||
|
cmd[0] = MSGCODE_GET_PHYSICAL_ADDRESS;
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 1, cmd[0], 1);
|
||
|
if (err)
|
||
|
return err;
|
||
|
*pa = (data[0] << 8) | data[1];
|
||
|
dev_dbg(pulse8->dev, "Physical address: %x.%x.%x.%x\n",
|
||
|
cec_phys_addr_exp(*pa));
|
||
|
|
||
|
cmd[0] = MSGCODE_GET_HDMI_VERSION;
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 1, cmd[0], 1);
|
||
|
if (err)
|
||
|
return err;
|
||
|
log_addrs->cec_version = data[0];
|
||
|
dev_dbg(pulse8->dev, "CEC version: %d\n", log_addrs->cec_version);
|
||
|
|
||
|
cmd[0] = MSGCODE_GET_OSD_NAME;
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 1, cmd[0], 0);
|
||
|
if (err)
|
||
|
return err;
|
||
|
strncpy(log_addrs->osd_name, data, 13);
|
||
|
dev_dbg(pulse8->dev, "OSD name: %s\n", log_addrs->osd_name);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int pulse8_apply_persistent_config(struct pulse8 *pulse8,
|
||
|
struct cec_log_addrs *log_addrs,
|
||
|
u16 pa)
|
||
|
{
|
||
|
int err;
|
||
|
|
||
|
err = cec_s_log_addrs(pulse8->adap, log_addrs, false);
|
||
|
if (err)
|
||
|
return err;
|
||
|
|
||
|
cec_s_phys_addr(pulse8->adap, pa, false);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int pulse8_cec_adap_enable(struct cec_adapter *adap, bool enable)
|
||
|
{
|
||
|
struct pulse8 *pulse8 = cec_get_drvdata(adap);
|
||
|
u8 cmd[16];
|
||
|
int err;
|
||
|
|
||
|
cmd[0] = MSGCODE_SET_CONTROLLED;
|
||
|
cmd[1] = enable;
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 2,
|
||
|
MSGCODE_COMMAND_ACCEPTED, 1);
|
||
|
return enable ? err : 0;
|
||
|
}
|
||
|
|
||
|
static int pulse8_cec_adap_log_addr(struct cec_adapter *adap, u8 log_addr)
|
||
|
{
|
||
|
struct pulse8 *pulse8 = cec_get_drvdata(adap);
|
||
|
u16 mask = 0;
|
||
|
u16 pa = adap->phys_addr;
|
||
|
u8 cmd[16];
|
||
|
int err = 0;
|
||
|
|
||
|
mutex_lock(&pulse8->config_lock);
|
||
|
if (log_addr != CEC_LOG_ADDR_INVALID)
|
||
|
mask = 1 << log_addr;
|
||
|
cmd[0] = MSGCODE_SET_ACK_MASK;
|
||
|
cmd[1] = mask >> 8;
|
||
|
cmd[2] = mask & 0xff;
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 3,
|
||
|
MSGCODE_COMMAND_ACCEPTED, 0);
|
||
|
if ((err && mask != 0) || pulse8->restoring_config)
|
||
|
goto unlock;
|
||
|
|
||
|
cmd[0] = MSGCODE_SET_AUTO_ENABLED;
|
||
|
cmd[1] = log_addr == CEC_LOG_ADDR_INVALID ? 0 : 1;
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 2,
|
||
|
MSGCODE_COMMAND_ACCEPTED, 0);
|
||
|
if (err)
|
||
|
goto unlock;
|
||
|
pulse8->autonomous = cmd[1];
|
||
|
if (log_addr == CEC_LOG_ADDR_INVALID)
|
||
|
goto unlock;
|
||
|
|
||
|
cmd[0] = MSGCODE_SET_DEVICE_TYPE;
|
||
|
cmd[1] = adap->log_addrs.primary_device_type[0];
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 2,
|
||
|
MSGCODE_COMMAND_ACCEPTED, 0);
|
||
|
if (err)
|
||
|
goto unlock;
|
||
|
|
||
|
switch (adap->log_addrs.primary_device_type[0]) {
|
||
|
case CEC_OP_PRIM_DEVTYPE_TV:
|
||
|
mask = CEC_LOG_ADDR_MASK_TV;
|
||
|
break;
|
||
|
case CEC_OP_PRIM_DEVTYPE_RECORD:
|
||
|
mask = CEC_LOG_ADDR_MASK_RECORD;
|
||
|
break;
|
||
|
case CEC_OP_PRIM_DEVTYPE_TUNER:
|
||
|
mask = CEC_LOG_ADDR_MASK_TUNER;
|
||
|
break;
|
||
|
case CEC_OP_PRIM_DEVTYPE_PLAYBACK:
|
||
|
mask = CEC_LOG_ADDR_MASK_PLAYBACK;
|
||
|
break;
|
||
|
case CEC_OP_PRIM_DEVTYPE_AUDIOSYSTEM:
|
||
|
mask = CEC_LOG_ADDR_MASK_AUDIOSYSTEM;
|
||
|
break;
|
||
|
case CEC_OP_PRIM_DEVTYPE_SWITCH:
|
||
|
mask = CEC_LOG_ADDR_MASK_UNREGISTERED;
|
||
|
break;
|
||
|
case CEC_OP_PRIM_DEVTYPE_PROCESSOR:
|
||
|
mask = CEC_LOG_ADDR_MASK_SPECIFIC;
|
||
|
break;
|
||
|
default:
|
||
|
mask = 0;
|
||
|
break;
|
||
|
}
|
||
|
cmd[0] = MSGCODE_SET_LOGICAL_ADDRESS_MASK;
|
||
|
cmd[1] = mask >> 8;
|
||
|
cmd[2] = mask & 0xff;
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 3,
|
||
|
MSGCODE_COMMAND_ACCEPTED, 0);
|
||
|
if (err)
|
||
|
goto unlock;
|
||
|
|
||
|
cmd[0] = MSGCODE_SET_DEFAULT_LOGICAL_ADDRESS;
|
||
|
cmd[1] = log_addr;
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 2,
|
||
|
MSGCODE_COMMAND_ACCEPTED, 0);
|
||
|
if (err)
|
||
|
goto unlock;
|
||
|
|
||
|
cmd[0] = MSGCODE_SET_PHYSICAL_ADDRESS;
|
||
|
cmd[1] = pa >> 8;
|
||
|
cmd[2] = pa & 0xff;
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 3,
|
||
|
MSGCODE_COMMAND_ACCEPTED, 0);
|
||
|
if (err)
|
||
|
goto unlock;
|
||
|
|
||
|
cmd[0] = MSGCODE_SET_HDMI_VERSION;
|
||
|
cmd[1] = adap->log_addrs.cec_version;
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 2,
|
||
|
MSGCODE_COMMAND_ACCEPTED, 0);
|
||
|
if (err)
|
||
|
goto unlock;
|
||
|
|
||
|
if (adap->log_addrs.osd_name[0]) {
|
||
|
size_t osd_len = strlen(adap->log_addrs.osd_name);
|
||
|
char *osd_str = cmd + 1;
|
||
|
|
||
|
cmd[0] = MSGCODE_SET_OSD_NAME;
|
||
|
strncpy(cmd + 1, adap->log_addrs.osd_name, 13);
|
||
|
if (osd_len < 4) {
|
||
|
memset(osd_str + osd_len, ' ', 4 - osd_len);
|
||
|
osd_len = 4;
|
||
|
osd_str[osd_len] = '\0';
|
||
|
strcpy(adap->log_addrs.osd_name, osd_str);
|
||
|
}
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 1 + osd_len,
|
||
|
MSGCODE_COMMAND_ACCEPTED, 0);
|
||
|
if (err)
|
||
|
goto unlock;
|
||
|
}
|
||
|
|
||
|
unlock:
|
||
|
if (pulse8->restoring_config)
|
||
|
pulse8->restoring_config = false;
|
||
|
else
|
||
|
pulse8->config_pending = true;
|
||
|
mutex_unlock(&pulse8->config_lock);
|
||
|
return log_addr == CEC_LOG_ADDR_INVALID ? 0 : err;
|
||
|
}
|
||
|
|
||
|
static int pulse8_cec_adap_transmit(struct cec_adapter *adap, u8 attempts,
|
||
|
u32 signal_free_time, struct cec_msg *msg)
|
||
|
{
|
||
|
struct pulse8 *pulse8 = cec_get_drvdata(adap);
|
||
|
u8 cmd[2];
|
||
|
unsigned int i;
|
||
|
int err;
|
||
|
|
||
|
cmd[0] = MSGCODE_TRANSMIT_IDLETIME;
|
||
|
cmd[1] = signal_free_time;
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 2,
|
||
|
MSGCODE_COMMAND_ACCEPTED, 1);
|
||
|
cmd[0] = MSGCODE_TRANSMIT_ACK_POLARITY;
|
||
|
cmd[1] = cec_msg_is_broadcast(msg);
|
||
|
if (!err)
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 2,
|
||
|
MSGCODE_COMMAND_ACCEPTED, 1);
|
||
|
cmd[0] = msg->len == 1 ? MSGCODE_TRANSMIT_EOM : MSGCODE_TRANSMIT;
|
||
|
cmd[1] = msg->msg[0];
|
||
|
if (!err)
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 2,
|
||
|
MSGCODE_COMMAND_ACCEPTED, 1);
|
||
|
if (!err && msg->len > 1) {
|
||
|
cmd[0] = msg->len == 2 ? MSGCODE_TRANSMIT_EOM :
|
||
|
MSGCODE_TRANSMIT;
|
||
|
cmd[1] = msg->msg[1];
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 2,
|
||
|
MSGCODE_COMMAND_ACCEPTED, 1);
|
||
|
for (i = 0; !err && i + 2 < msg->len; i++) {
|
||
|
cmd[0] = (i + 2 == msg->len - 1) ?
|
||
|
MSGCODE_TRANSMIT_EOM : MSGCODE_TRANSMIT;
|
||
|
cmd[1] = msg->msg[i + 2];
|
||
|
err = pulse8_send_and_wait(pulse8, cmd, 2,
|
||
|
MSGCODE_COMMAND_ACCEPTED, 1);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
static int pulse8_received(struct cec_adapter *adap, struct cec_msg *msg)
|
||
|
{
|
||
|
return -ENOMSG;
|
||
|
}
|
||
|
|
||
|
static const struct cec_adap_ops pulse8_cec_adap_ops = {
|
||
|
.adap_enable = pulse8_cec_adap_enable,
|
||
|
.adap_log_addr = pulse8_cec_adap_log_addr,
|
||
|
.adap_transmit = pulse8_cec_adap_transmit,
|
||
|
.received = pulse8_received,
|
||
|
};
|
||
|
|
||
|
static int pulse8_connect(struct serio *serio, struct serio_driver *drv)
|
||
|
{
|
||
|
u32 caps = CEC_CAP_DEFAULTS | CEC_CAP_PHYS_ADDR | CEC_CAP_MONITOR_ALL;
|
||
|
struct pulse8 *pulse8;
|
||
|
int err = -ENOMEM;
|
||
|
struct cec_log_addrs log_addrs = {};
|
||
|
u16 pa = CEC_PHYS_ADDR_INVALID;
|
||
|
|
||
|
pulse8 = kzalloc(sizeof(*pulse8), GFP_KERNEL);
|
||
|
|
||
|
if (!pulse8)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
pulse8->serio = serio;
|
||
|
pulse8->adap = cec_allocate_adapter(&pulse8_cec_adap_ops, pulse8,
|
||
|
dev_name(&serio->dev), caps, 1);
|
||
|
err = PTR_ERR_OR_ZERO(pulse8->adap);
|
||
|
if (err < 0)
|
||
|
goto free_device;
|
||
|
|
||
|
pulse8->dev = &serio->dev;
|
||
|
serio_set_drvdata(serio, pulse8);
|
||
|
INIT_WORK(&pulse8->work, pulse8_irq_work_handler);
|
||
|
mutex_init(&pulse8->write_lock);
|
||
|
mutex_init(&pulse8->config_lock);
|
||
|
pulse8->config_pending = false;
|
||
|
|
||
|
err = serio_open(serio, drv);
|
||
|
if (err)
|
||
|
goto delete_adap;
|
||
|
|
||
|
err = pulse8_setup(pulse8, serio, &log_addrs, &pa);
|
||
|
if (err)
|
||
|
goto close_serio;
|
||
|
|
||
|
err = cec_register_adapter(pulse8->adap, &serio->dev);
|
||
|
if (err < 0)
|
||
|
goto close_serio;
|
||
|
|
||
|
pulse8->dev = &pulse8->adap->devnode.dev;
|
||
|
|
||
|
if (persistent_config && pulse8->autonomous) {
|
||
|
err = pulse8_apply_persistent_config(pulse8, &log_addrs, pa);
|
||
|
if (err)
|
||
|
goto close_serio;
|
||
|
pulse8->restoring_config = true;
|
||
|
}
|
||
|
|
||
|
INIT_DELAYED_WORK(&pulse8->ping_eeprom_work,
|
||
|
pulse8_ping_eeprom_work_handler);
|
||
|
schedule_delayed_work(&pulse8->ping_eeprom_work, PING_PERIOD);
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
close_serio:
|
||
|
serio_close(serio);
|
||
|
delete_adap:
|
||
|
cec_delete_adapter(pulse8->adap);
|
||
|
serio_set_drvdata(serio, NULL);
|
||
|
free_device:
|
||
|
kfree(pulse8);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
static void pulse8_ping_eeprom_work_handler(struct work_struct *work)
|
||
|
{
|
||
|
struct pulse8 *pulse8 =
|
||
|
container_of(work, struct pulse8, ping_eeprom_work.work);
|
||
|
u8 cmd;
|
||
|
|
||
|
schedule_delayed_work(&pulse8->ping_eeprom_work, PING_PERIOD);
|
||
|
cmd = MSGCODE_PING;
|
||
|
pulse8_send_and_wait(pulse8, &cmd, 1,
|
||
|
MSGCODE_COMMAND_ACCEPTED, 0);
|
||
|
|
||
|
if (pulse8->vers < 2)
|
||
|
return;
|
||
|
|
||
|
mutex_lock(&pulse8->config_lock);
|
||
|
if (pulse8->config_pending && persistent_config) {
|
||
|
dev_dbg(pulse8->dev, "writing pending config to EEPROM\n");
|
||
|
cmd = MSGCODE_WRITE_EEPROM;
|
||
|
if (pulse8_send_and_wait(pulse8, &cmd, 1,
|
||
|
MSGCODE_COMMAND_ACCEPTED, 0))
|
||
|
dev_info(pulse8->dev, "failed to write pending config to EEPROM\n");
|
||
|
else
|
||
|
pulse8->config_pending = false;
|
||
|
}
|
||
|
mutex_unlock(&pulse8->config_lock);
|
||
|
}
|
||
|
|
||
|
static const struct serio_device_id pulse8_serio_ids[] = {
|
||
|
{
|
||
|
.type = SERIO_RS232,
|
||
|
.proto = SERIO_PULSE8_CEC,
|
||
|
.id = SERIO_ANY,
|
||
|
.extra = SERIO_ANY,
|
||
|
},
|
||
|
{ 0 }
|
||
|
};
|
||
|
|
||
|
MODULE_DEVICE_TABLE(serio, pulse8_serio_ids);
|
||
|
|
||
|
static struct serio_driver pulse8_drv = {
|
||
|
.driver = {
|
||
|
.name = "pulse8-cec",
|
||
|
},
|
||
|
.description = "Pulse Eight HDMI CEC driver",
|
||
|
.id_table = pulse8_serio_ids,
|
||
|
.interrupt = pulse8_interrupt,
|
||
|
.connect = pulse8_connect,
|
||
|
.disconnect = pulse8_disconnect,
|
||
|
};
|
||
|
|
||
|
module_serio_driver(pulse8_drv);
|