You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
722 lines
24 KiB
722 lines
24 KiB
/*
|
|
* Copyright (c) 2014, 2016-2017, The Linux Foundation. All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions are
|
|
* met:
|
|
* * Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* * Redistributions in binary form must reproduce the above
|
|
* copyright notice, this list of conditions and the following
|
|
* disclaimer in the documentation and/or other materials provided
|
|
* with the distribution.
|
|
* * Neither the name of The Linux Foundation. nor the names of its
|
|
* contributors may be used to endorse or promote products derived
|
|
* from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
|
|
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
|
|
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
|
|
* BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
|
|
* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
|
|
* OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
|
|
* IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
#define DEBUG 0
|
|
#define ATRACE_TAG (ATRACE_TAG_GRAPHICS | ATRACE_TAG_HAL)
|
|
#include <log/log.h>
|
|
#include <errno.h>
|
|
#include <hardware/hdmi_cec.h>
|
|
#include <utils/Trace.h>
|
|
#include <utils/debug.h>
|
|
#include <utils/sys.h>
|
|
#include <vector>
|
|
#include "qhdmi_cec.h"
|
|
|
|
namespace qhdmicec {
|
|
|
|
const int NUM_HDMI_PORTS = 1;
|
|
const int MAX_SYSFS_DATA = 128;
|
|
const int MAX_CEC_FRAME_SIZE = 20;
|
|
const int MAX_SEND_MESSAGE_RETRIES = 1;
|
|
|
|
const char* SYSFS_BASE = "/sys/devices/virtual/graphics/fb";
|
|
const char* UEVENT_SWITCH_HDMI = "change@/devices/virtual/switch/hdmi";
|
|
const char* FB_PATH = "/sys/devices/virtual/graphics/fb";
|
|
|
|
enum {
|
|
LOGICAL_ADDRESS_SET = 1,
|
|
LOGICAL_ADDRESS_UNSET = -1,
|
|
};
|
|
|
|
// Offsets of members of struct hdmi_cec_msg
|
|
// drivers/video/msm/mdss/mdss_hdmi_cec.c
|
|
// XXX: Get this from a driver header
|
|
enum {
|
|
CEC_OFFSET_SENDER_ID,
|
|
CEC_OFFSET_RECEIVER_ID,
|
|
CEC_OFFSET_OPCODE,
|
|
CEC_OFFSET_OPERAND,
|
|
CEC_OFFSET_FRAME_LENGTH = 17,
|
|
CEC_OFFSET_RETRANSMIT,
|
|
};
|
|
|
|
//Forward declarations
|
|
static void cec_close_context(cec_context_t* ctx __unused);
|
|
static int cec_enable(cec_context_t *ctx, int enable);
|
|
static int cec_is_connected(const struct hdmi_cec_device* dev, int port_id);
|
|
static void cec_monitor_deinit(cec_context_t* ctx);
|
|
static void handle_cec_msg_event(cec_context_t* ctx, uint32_t node_event);
|
|
|
|
void event_monitor(cec_context_t* ctx); // hdmi event monitor function
|
|
static int get_event_value(const char *uevent_data, int length, const char *event_info);
|
|
static int uevent_init(int *uevent_fd);
|
|
static void handle_hdmihotplug_event(cec_context_t* ctx, uint32_t node_event);
|
|
|
|
static int populate_event_data(cec_context_t* ctx, std::vector<eventData> *event_data_list);
|
|
static int set_event_params(cec_context_t* ctx, uint32_t node_event, eventData *event_data);
|
|
static void handle_exit_event(cec_context_t* ctx, uint32_t node_event);
|
|
|
|
static ssize_t read_node(const char *path, char *data)
|
|
{
|
|
ssize_t err = 0;
|
|
FILE *fp = NULL;
|
|
err = access(path, R_OK);
|
|
if (!err) {
|
|
fp = fopen(path, "r");
|
|
if (fp) {
|
|
err = fread(data, sizeof(char), MAX_SYSFS_DATA ,fp);
|
|
fclose(fp);
|
|
}
|
|
}
|
|
return err;
|
|
}
|
|
|
|
static ssize_t write_node(const char *path, const char *data, size_t len)
|
|
{
|
|
ssize_t err = 0;
|
|
int fd = -1;
|
|
err = access(path, W_OK);
|
|
if (!err) {
|
|
fd = open(path, O_WRONLY);
|
|
errno = 0;
|
|
err = write(fd, data, len);
|
|
if (err < 0) {
|
|
err = -errno;
|
|
}
|
|
close(fd);
|
|
} else {
|
|
ALOGE("%s: Failed to access path: %s error: %s",
|
|
__FUNCTION__, path, strerror(errno));
|
|
err = -errno;
|
|
}
|
|
return err;
|
|
}
|
|
|
|
// Helper function to write integer values to the full sysfs path
|
|
static ssize_t write_int_to_node(cec_context_t *ctx,
|
|
const char *path_postfix,
|
|
const int value)
|
|
{
|
|
std::string sysfs_full_path;
|
|
char sysfs_data[MAX_SYSFS_DATA];
|
|
snprintf(sysfs_data, sizeof(sysfs_data), "%d",value);
|
|
sysfs_full_path = ctx->fb_sysfs_path + "/";
|
|
sysfs_full_path.append(path_postfix);
|
|
ssize_t err = write_node(sysfs_full_path.c_str(), sysfs_data, strlen(sysfs_data));
|
|
return err;
|
|
}
|
|
|
|
static void hex_to_string(const char *msg, ssize_t len, char *str)
|
|
{
|
|
//Functions assumes sufficient memory in str
|
|
char *ptr = str;
|
|
for(int i=0; i < len ; i++) {
|
|
ptr += snprintf(ptr, 3, "%02X", msg[i]);
|
|
// Overwrite null termination of snprintf in all except the last byte
|
|
if (i < len - 1)
|
|
*ptr = ':';
|
|
ptr++;
|
|
}
|
|
}
|
|
|
|
static ssize_t cec_get_fb_node_number(cec_context_t *ctx)
|
|
{
|
|
//XXX: Do this from a common utility library across the display HALs
|
|
const int MAX_FB_DEVICES = 2;
|
|
ssize_t len = 0;
|
|
std::string fb_type_path;
|
|
char fb_type[MAX_SYSFS_DATA];
|
|
const char *dtv_panel_str = "dtv panel";
|
|
|
|
for(int num = 0; num < MAX_FB_DEVICES; num++) {
|
|
fb_type_path = SYSFS_BASE + std::to_string(ctx->fb_num) + "/msm_fb_type";
|
|
len = read_node(fb_type_path.c_str(), fb_type);
|
|
ALOGD_IF(DEBUG, "%s: fb_type:%s", __FUNCTION__, fb_type);
|
|
if(len > 0 && (strncmp(fb_type, dtv_panel_str, strlen(dtv_panel_str)) == 0)){
|
|
ALOGD_IF(DEBUG, "%s: Found DTV panel at fb%d", __FUNCTION__, num);
|
|
ctx->fb_num = num;
|
|
ctx->fb_sysfs_path = SYSFS_BASE + std::to_string(ctx->fb_num);
|
|
break;
|
|
}
|
|
}
|
|
if (len < 0)
|
|
return len;
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
static int cec_add_logical_address(const struct hdmi_cec_device* dev,
|
|
cec_logical_address_t addr)
|
|
{
|
|
if (addr < CEC_ADDR_TV || addr > CEC_ADDR_BROADCAST) {
|
|
ALOGE("%s: Received invalid address: %d ", __FUNCTION__, addr);
|
|
return -EINVAL;
|
|
}
|
|
cec_context_t* ctx = (cec_context_t*)(dev);
|
|
ctx->logical_address[addr] = LOGICAL_ADDRESS_SET;
|
|
|
|
//XXX: We can get multiple logical addresses here but we can only send one
|
|
//to the driver. Store locally for now
|
|
ssize_t err = write_int_to_node(ctx, "cec/logical_addr", addr);
|
|
ALOGI("%s: Allocated logical address: %d ", __FUNCTION__, addr);
|
|
return (int) err;
|
|
}
|
|
|
|
static void cec_clear_logical_address(const struct hdmi_cec_device* dev)
|
|
{
|
|
cec_context_t* ctx = (cec_context_t*)(dev);
|
|
memset(ctx->logical_address, LOGICAL_ADDRESS_UNSET,
|
|
sizeof(ctx->logical_address));
|
|
//XXX: Find logical_addr that needs to be reset
|
|
write_int_to_node(ctx, "cec/logical_addr", 15);
|
|
ALOGD_IF(DEBUG, "%s: Cleared logical addresses", __FUNCTION__);
|
|
}
|
|
|
|
static int cec_get_physical_address(const struct hdmi_cec_device* dev,
|
|
uint16_t* addr)
|
|
{
|
|
cec_context_t* ctx = (cec_context_t*)(dev);
|
|
std::string pa_path;
|
|
char pa_data[MAX_SYSFS_DATA];
|
|
pa_path = ctx->fb_sysfs_path;
|
|
pa_path.append("/pa");
|
|
int err = (int) read_node(pa_path.c_str(), pa_data);
|
|
*addr = (uint16_t) atoi(pa_data);
|
|
ALOGD_IF(DEBUG, "%s: Physical Address: 0x%x", __FUNCTION__, *addr);
|
|
if (err < 0)
|
|
return err;
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
static int cec_send_message(const struct hdmi_cec_device* dev,
|
|
const cec_message_t* msg)
|
|
{
|
|
ATRACE_CALL();
|
|
if(cec_is_connected(dev, 0) <= 0)
|
|
return HDMI_RESULT_FAIL;
|
|
|
|
cec_context_t* ctx = (cec_context_t*)(dev);
|
|
ALOGD_IF(DEBUG, "%s: initiator: %d destination: %d length: %u",
|
|
__FUNCTION__, msg->initiator, msg->destination,
|
|
(uint32_t) msg->length);
|
|
|
|
// Dump message received from framework
|
|
char dump[128];
|
|
if(msg->length > 0) {
|
|
hex_to_string((char*)msg->body, msg->length, dump);
|
|
ALOGD_IF(DEBUG, "%s: message from framework: %s", __FUNCTION__, dump);
|
|
}
|
|
|
|
std::string write_msg_path;
|
|
char write_msg[MAX_CEC_FRAME_SIZE];
|
|
memset(write_msg, 0, sizeof(write_msg));
|
|
// See definition of struct hdmi_cec_msg in driver code
|
|
// drivers/video/msm/mdss/mdss_hdmi_cec.c
|
|
// Write header block
|
|
// XXX: Include this from header in kernel
|
|
write_msg[CEC_OFFSET_SENDER_ID] = msg->initiator;
|
|
write_msg[CEC_OFFSET_RECEIVER_ID] = msg->destination;
|
|
//Kernel splits opcode/operand, but Android sends it in one byte array
|
|
write_msg[CEC_OFFSET_OPCODE] = msg->body[0];
|
|
if(msg->length > 1) {
|
|
memcpy(&write_msg[CEC_OFFSET_OPERAND], &msg->body[1],
|
|
sizeof(char)*(msg->length - 1));
|
|
}
|
|
//msg length + initiator + destination
|
|
write_msg[CEC_OFFSET_FRAME_LENGTH] = (unsigned char) (msg->length + 1);
|
|
hex_to_string(write_msg, sizeof(write_msg), dump);
|
|
write_msg_path = ctx->fb_sysfs_path;
|
|
write_msg_path.append("/cec/wr_msg");
|
|
int retry_count = 0;
|
|
ssize_t err = 0;
|
|
//HAL spec requires us to retry at least once.
|
|
while (true) {
|
|
err = write_node(write_msg_path.c_str(), write_msg, sizeof(write_msg));
|
|
retry_count++;
|
|
if (err == -EAGAIN && retry_count <= MAX_SEND_MESSAGE_RETRIES) {
|
|
ALOGE("%s: CEC line busy, retrying", __FUNCTION__);
|
|
} else {
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (err < 0) {
|
|
if (err == -ENXIO) {
|
|
ALOGI("%s: No device exists with the destination address",
|
|
__FUNCTION__);
|
|
return HDMI_RESULT_NACK;
|
|
} else if (err == -EAGAIN) {
|
|
ALOGE("%s: CEC line is busy, max retry count exceeded",
|
|
__FUNCTION__);
|
|
return HDMI_RESULT_BUSY;
|
|
} else {
|
|
return HDMI_RESULT_FAIL;
|
|
ALOGE("%s: Failed to send CEC message err: %zd - %s",
|
|
__FUNCTION__, err, strerror(int(-err)));
|
|
}
|
|
} else {
|
|
ALOGD_IF(DEBUG, "%s: Sent CEC message - %zd bytes written",
|
|
__FUNCTION__, err);
|
|
return HDMI_RESULT_SUCCESS;
|
|
}
|
|
}
|
|
|
|
void cec_receive_message(cec_context_t *ctx, char *msg, ssize_t len)
|
|
{
|
|
if(!ctx->system_control)
|
|
return;
|
|
|
|
char dump[128];
|
|
if(len > 0) {
|
|
hex_to_string(msg, len, dump);
|
|
ALOGD_IF(DEBUG, "%s: Message from driver: %s", __FUNCTION__, dump);
|
|
}
|
|
|
|
hdmi_event_t event;
|
|
event.type = HDMI_EVENT_CEC_MESSAGE;
|
|
event.dev = (hdmi_cec_device *) ctx;
|
|
// Remove initiator/destination from this calculation
|
|
event.cec.length = msg[CEC_OFFSET_FRAME_LENGTH] - 1;
|
|
event.cec.initiator = (cec_logical_address_t) msg[CEC_OFFSET_SENDER_ID];
|
|
event.cec.destination = (cec_logical_address_t) msg[CEC_OFFSET_RECEIVER_ID];
|
|
//Copy opcode and operand
|
|
size_t copy_size = event.cec.length > sizeof(event.cec.body) ?
|
|
sizeof(event.cec.body) : event.cec.length;
|
|
memcpy(event.cec.body, &msg[CEC_OFFSET_OPCODE],copy_size);
|
|
hex_to_string((char *) event.cec.body, copy_size, dump);
|
|
ALOGD_IF(DEBUG, "%s: Message to framework: %s", __FUNCTION__, dump);
|
|
ctx->callback.callback_func(&event, ctx->callback.callback_arg);
|
|
}
|
|
|
|
void cec_hdmi_hotplug(cec_context_t *ctx, int connected)
|
|
{
|
|
//Ignore unplug events when system control is disabled
|
|
if(!ctx->system_control && connected == 0)
|
|
return;
|
|
hdmi_event_t event;
|
|
event.type = HDMI_EVENT_HOT_PLUG;
|
|
event.dev = (hdmi_cec_device *) ctx;
|
|
event.hotplug.connected = connected ? HDMI_CONNECTED : HDMI_NOT_CONNECTED;
|
|
ctx->callback.callback_func(&event, ctx->callback.callback_arg);
|
|
}
|
|
|
|
static void cec_register_event_callback(const struct hdmi_cec_device* dev,
|
|
event_callback_t callback, void* arg)
|
|
{
|
|
ALOGD_IF(DEBUG, "%s: Registering callback", __FUNCTION__);
|
|
cec_context_t* ctx = (cec_context_t*)(dev);
|
|
ctx->callback.callback_func = callback;
|
|
ctx->callback.callback_arg = arg;
|
|
}
|
|
|
|
static void cec_get_version(const struct hdmi_cec_device* dev, int* version)
|
|
{
|
|
cec_context_t* ctx = (cec_context_t*)(dev);
|
|
*version = ctx->version;
|
|
ALOGD_IF(DEBUG, "%s: version: %d", __FUNCTION__, *version);
|
|
}
|
|
|
|
static void cec_get_vendor_id(const struct hdmi_cec_device* dev,
|
|
uint32_t* vendor_id)
|
|
{
|
|
cec_context_t* ctx = (cec_context_t*)(dev);
|
|
*vendor_id = ctx->vendor_id;
|
|
ALOGD_IF(DEBUG, "%s: vendor id: %u", __FUNCTION__, *vendor_id);
|
|
}
|
|
|
|
static void cec_get_port_info(const struct hdmi_cec_device* dev,
|
|
struct hdmi_port_info* list[], int* total)
|
|
{
|
|
ALOGD_IF(DEBUG, "%s: Get port info", __FUNCTION__);
|
|
cec_context_t* ctx = (cec_context_t*)(dev);
|
|
*total = NUM_HDMI_PORTS;
|
|
*list = ctx->port_info;
|
|
}
|
|
|
|
static void cec_set_option(const struct hdmi_cec_device* dev, int flag,
|
|
int value)
|
|
{
|
|
cec_context_t* ctx = (cec_context_t*)(dev);
|
|
switch (flag) {
|
|
case HDMI_OPTION_WAKEUP:
|
|
ALOGD_IF(DEBUG, "%s: Wakeup: value: %d", __FUNCTION__, value);
|
|
//XXX
|
|
break;
|
|
case HDMI_OPTION_ENABLE_CEC:
|
|
ALOGD_IF(DEBUG, "%s: Enable CEC: value: %d", __FUNCTION__, value);
|
|
cec_enable(ctx, value? 1 : 0);
|
|
break;
|
|
case HDMI_OPTION_SYSTEM_CEC_CONTROL:
|
|
ALOGD_IF(DEBUG, "%s: system_control: value: %d",
|
|
__FUNCTION__, value);
|
|
ctx->system_control = !!value;
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void cec_set_audio_return_channel(const struct hdmi_cec_device* dev,
|
|
int port, int flag)
|
|
{
|
|
cec_context_t* ctx = (cec_context_t*)(dev);
|
|
ctx->arc_enabled = flag ? true : false;
|
|
ALOGD_IF(DEBUG, "%s: ARC flag: %d port: %d", __FUNCTION__, flag, port);
|
|
}
|
|
|
|
static int cec_is_connected(const struct hdmi_cec_device* dev, int port_id)
|
|
{
|
|
// Ignore port_id since we have only one port
|
|
int connected = 0;
|
|
cec_context_t* ctx = (cec_context_t*)(dev);
|
|
std::string connected_path;
|
|
char connected_data[MAX_SYSFS_DATA];
|
|
connected_path = ctx->fb_sysfs_path;
|
|
connected_path.append("/connected");
|
|
ssize_t err = read_node(connected_path.c_str(), connected_data);
|
|
connected = atoi(connected_data);
|
|
|
|
ALOGD_IF(DEBUG, "%s: HDMI at port %d is - %s", __FUNCTION__, port_id,
|
|
connected ? "connected":"disconnected");
|
|
if (err < 0)
|
|
return (int) err;
|
|
else
|
|
return connected;
|
|
}
|
|
|
|
static int cec_device_close(struct hw_device_t *dev)
|
|
{
|
|
ALOGD_IF(DEBUG, "%s: Close CEC HAL ", __FUNCTION__);
|
|
if (!dev) {
|
|
ALOGE("%s: NULL device pointer", __FUNCTION__);
|
|
return -EINVAL;
|
|
}
|
|
cec_context_t* ctx = (cec_context_t*)(dev);
|
|
cec_close_context(ctx);
|
|
free(dev);
|
|
return 0;
|
|
}
|
|
|
|
static int cec_enable(cec_context_t *ctx, int enable)
|
|
{
|
|
ssize_t err;
|
|
// Enable CEC
|
|
int value = enable ? 0x3 : 0x0;
|
|
err = write_int_to_node(ctx, "cec/enable", value);
|
|
if(err < 0) {
|
|
ALOGE("%s: Failed to toggle CEC: enable: %d",
|
|
__FUNCTION__, enable);
|
|
return (int) err;
|
|
}
|
|
ctx->enabled = enable;
|
|
return 0;
|
|
}
|
|
|
|
static void cec_init_context(cec_context_t *ctx)
|
|
{
|
|
ALOGD_IF(DEBUG, "%s: Initializing context", __FUNCTION__);
|
|
int err = -EINVAL;
|
|
cec_get_fb_node_number(ctx);
|
|
|
|
//Initialize ports - We support only one output port
|
|
ctx->port_info = new hdmi_port_info[NUM_HDMI_PORTS];
|
|
ctx->port_info[0].type = HDMI_OUTPUT;
|
|
ctx->port_info[0].port_id = 1;
|
|
ctx->port_info[0].cec_supported = 1;
|
|
//XXX: Enable ARC if supported
|
|
ctx->port_info[0].arc_supported = 0;
|
|
cec_get_physical_address((hdmi_cec_device *) ctx,
|
|
&ctx->port_info[0].physical_address );
|
|
|
|
ctx->version = 0x4;
|
|
ctx->vendor_id = 0xA47733;
|
|
cec_clear_logical_address((hdmi_cec_device_t*)ctx);
|
|
|
|
//Enable CEC - framework expects it to be enabled by default
|
|
cec_enable(ctx, true);
|
|
|
|
ALOGD("%s: CEC enabled", __FUNCTION__);
|
|
|
|
ctx->node_list.push_back("cec_msg_event");
|
|
ctx->node_list.push_back("hotplug_event");
|
|
ctx->node_list.push_back("exit_event");
|
|
|
|
err = populate_event_data(ctx, &ctx->event_data_list);
|
|
if (err < 0) {
|
|
ALOGE("Failed to populate poll parameters for monitoring HDMI CEC events. Exiting.");
|
|
cec_enable(ctx, false);
|
|
return;
|
|
}
|
|
|
|
ctx->hdmi_cec_monitor = std::thread(event_monitor, ctx);
|
|
|
|
}
|
|
|
|
static void cec_close_context(cec_context_t* ctx __unused)
|
|
{
|
|
ALOGD("%s: Closing context", __FUNCTION__);
|
|
|
|
uint64_t exit_value = 1;
|
|
long int write_size = write(ctx->exit_fd, &exit_value, sizeof(uint64_t));
|
|
|
|
if (write_size != sizeof(uint64_t)) {
|
|
ALOGE("Error triggering exit_fd (%d). write size = %ld, error = %s",
|
|
ctx->exit_fd, write_size, strerror(errno));
|
|
return;
|
|
}
|
|
|
|
if (ctx->hdmi_cec_monitor.joinable()) {
|
|
ctx->hdmi_cec_monitor.join();
|
|
}
|
|
}
|
|
|
|
static int cec_device_open(const struct hw_module_t* module,
|
|
const char* name,
|
|
struct hw_device_t** device)
|
|
{
|
|
ALOGD_IF(DEBUG, "%s: name: %s", __FUNCTION__, name);
|
|
int status = -EINVAL;
|
|
if (!strcmp(name, HDMI_CEC_HARDWARE_INTERFACE )) {
|
|
struct cec_context_t *dev;
|
|
dev = (cec_context_t *) calloc (1, sizeof(*dev));
|
|
if (dev) {
|
|
cec_init_context(dev);
|
|
//Setup CEC methods
|
|
dev->device.common.tag = HARDWARE_DEVICE_TAG;
|
|
dev->device.common.version = HDMI_CEC_DEVICE_API_VERSION_1_0;
|
|
dev->device.common.module = const_cast<hw_module_t* >(module);
|
|
dev->device.common.close = cec_device_close;
|
|
dev->device.add_logical_address = cec_add_logical_address;
|
|
dev->device.clear_logical_address = cec_clear_logical_address;
|
|
dev->device.get_physical_address = cec_get_physical_address;
|
|
dev->device.send_message = cec_send_message;
|
|
dev->device.register_event_callback = cec_register_event_callback;
|
|
dev->device.get_version = cec_get_version;
|
|
dev->device.get_vendor_id = cec_get_vendor_id;
|
|
dev->device.get_port_info = cec_get_port_info;
|
|
dev->device.set_option = cec_set_option;
|
|
dev->device.set_audio_return_channel = cec_set_audio_return_channel;
|
|
dev->device.is_connected = cec_is_connected;
|
|
|
|
*device = &dev->device.common;
|
|
status = 0;
|
|
} else {
|
|
status = -EINVAL;
|
|
}
|
|
}
|
|
return status;
|
|
}
|
|
|
|
void event_monitor(cec_context_t* ctx) {
|
|
ALOGD("%s IN", __FUNCTION__);
|
|
int err = -EINVAL;
|
|
|
|
prctl(PR_SET_NAME, "cec_monitor", 0, 0, 0);
|
|
setpriority(PRIO_PROCESS, 0, HAL_PRIORITY_URGENT_DISPLAY);
|
|
|
|
while (!ctx->cec_exit_thread) {
|
|
err = poll(ctx->poll_fds.data(), (nfds_t)ctx->event_data_list.size(), -1);
|
|
if ( err <= 0 ) {
|
|
ALOGI("Failed to poll, Error %s", strerror(errno));
|
|
continue;
|
|
}
|
|
|
|
for (uint32_t event = 0; event < ctx->event_data_list.size(); event++) {
|
|
pollfd &poll_fd = ctx->poll_fds[event];
|
|
|
|
if (poll_fd.revents & POLLIN || poll_fd.revents & POLLPRI) {
|
|
ctx->event_data_list[event].event_parser(ctx, event);
|
|
}
|
|
}
|
|
}
|
|
|
|
cec_monitor_deinit(ctx);
|
|
ALOGD("%s OUT", __FUNCTION__);
|
|
return;
|
|
}
|
|
|
|
static int populate_event_data(cec_context_t* ctx, std::vector<eventData> *event_data_list) {
|
|
int err = -EINVAL;
|
|
ctx->poll_fds.resize(ctx->node_list.size());
|
|
|
|
for (uint32_t event = 0; event < ctx->node_list.size(); event++) {
|
|
const char *event_name = ctx->node_list.at(event).c_str();
|
|
eventData event_data;
|
|
event_data.event_name = event_name;
|
|
err = set_event_params(ctx, event, &event_data);
|
|
if (err < 0) {
|
|
ALOGE("Failed to set poll event parameters");
|
|
return err;
|
|
}
|
|
|
|
event_data_list->push_back(event_data);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int set_event_params(cec_context_t* ctx, uint32_t node_event, eventData *event_data) {
|
|
pollfd poll_fd;
|
|
poll_fd.fd = -EINVAL;
|
|
|
|
if (!strncmp(event_data->event_name, "cec_msg_event", strlen("cec_msg_event"))) {
|
|
char node_path[MAX_STRING_LENGTH] = {0};
|
|
|
|
snprintf(node_path, sizeof(node_path), "%s%d/%s", FB_PATH, ctx->fb_num, "cec/rd_msg");
|
|
poll_fd.fd = open(node_path, O_RDONLY);
|
|
if (poll_fd.fd < 0) {
|
|
ALOGE("Node open failed for display %d event %s error %s",
|
|
ctx->fb_num, "cec/rd_msg", strerror(errno));
|
|
return poll_fd.fd;
|
|
}
|
|
|
|
poll_fd.events |= POLLPRI | POLLERR;
|
|
// Read once on fd to clear the data
|
|
pread(poll_fd.fd, ctx->data, MAX_STRING_LENGTH, 0);
|
|
event_data->event_parser = &handle_cec_msg_event;
|
|
} else if (!strncmp(event_data->event_name, "hotplug_event", strlen("hotplug_event"))) {
|
|
if (!uevent_init(&poll_fd.fd)) {
|
|
ALOGE("Failed to register uevent for hotplug detection");
|
|
return -1;
|
|
}
|
|
|
|
poll_fd.events |= POLLIN | POLLERR;
|
|
event_data->event_parser = &handle_hdmihotplug_event;
|
|
} else if (!strncmp(event_data->event_name, "exit_event", strlen("exit_event"))) {
|
|
poll_fd.fd = eventfd(0, 0);
|
|
poll_fd.events |= POLLIN;
|
|
event_data->event_parser = &handle_exit_event;
|
|
ctx->exit_fd = poll_fd.fd;
|
|
}
|
|
|
|
ctx->poll_fds[node_event] = poll_fd;
|
|
return 0;
|
|
}
|
|
|
|
static void handle_cec_msg_event(cec_context_t* ctx, uint32_t node_event) {
|
|
if ((ctx->poll_fds[node_event].revents & POLLPRI) &&
|
|
(pread(ctx->poll_fds[node_event].fd, ctx->data, MAX_STRING_LENGTH, 0) > 0)) {
|
|
ALOGD_IF(DEBUG, "Handling CEC message %s", __FUNCTION__);
|
|
cec_receive_message(ctx, ctx->data, 0);
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
static void handle_hdmihotplug_event(cec_context_t* ctx, uint32_t node_event) {
|
|
char uevent_data[PAGE_SIZE];
|
|
int count = 0;
|
|
|
|
if (ctx->poll_fds[node_event].revents & POLLIN) {
|
|
count = static_cast<int> (recv(ctx->poll_fds[node_event].fd, uevent_data,
|
|
(INT32(sizeof(uevent_data))) - 2, 0));
|
|
|
|
if ((count > 0) && (strcasestr(UEVENT_SWITCH_HDMI, uevent_data))) {
|
|
int connected = get_event_value(uevent_data, count, "SWITCH_STATE=");
|
|
ALOGD("HDMI CEC is %s", connected ? "connected" : "disconnected");
|
|
cec_hdmi_hotplug(ctx, connected);
|
|
}
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
static void handle_exit_event(cec_context_t* ctx, uint32_t node_event) {
|
|
ALOGD_IF(DEBUG, "Enter %s", __FUNCTION__);
|
|
|
|
if (ctx->poll_fds[node_event].revents & POLLIN) {
|
|
ctx->cec_exit_thread = true;
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
static void cec_monitor_deinit(cec_context_t* ctx) {
|
|
for (uint32_t event = 0; event < ctx->poll_fds.size(); event++) {
|
|
close(ctx->poll_fds[event].fd);
|
|
ctx->poll_fds[event].fd = -1;
|
|
}
|
|
}
|
|
|
|
static int get_event_value(const char *uevent_data, int length, const char *event_info) {
|
|
const char *iterator_str = uevent_data;
|
|
while (((iterator_str - uevent_data) <= length) && (*iterator_str)) {
|
|
const char *pstr = strstr(iterator_str, event_info);
|
|
if (pstr != NULL) {
|
|
return (atoi(iterator_str + strlen(event_info)));
|
|
}
|
|
iterator_str += strlen(iterator_str) + 1;
|
|
}
|
|
return -1;
|
|
}
|
|
|
|
/* Returns 0 on failure, 1 on success */
|
|
static int uevent_init(int *uevent_fd) {
|
|
struct sockaddr_nl addr;
|
|
int sz = 64*1024;
|
|
int s;
|
|
|
|
memset(&addr, 0, sizeof(addr));
|
|
addr.nl_family = AF_NETLINK;
|
|
addr.nl_pid = getpid();
|
|
addr.nl_groups = 0xffffffff;
|
|
|
|
s = socket(PF_NETLINK, SOCK_DGRAM, NETLINK_KOBJECT_UEVENT);
|
|
if (s < 0)
|
|
return 0;
|
|
|
|
setsockopt(s, SOL_SOCKET, SO_RCVBUFFORCE, &sz, sizeof(sz));
|
|
|
|
if (bind(s, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
|
|
close(s);
|
|
return 0;
|
|
}
|
|
|
|
*uevent_fd = s;
|
|
return (*uevent_fd > 0);
|
|
}
|
|
|
|
}; //namespace qhdmicec
|
|
|
|
// Standard HAL module, should be outside qhdmicec namespace
|
|
static struct hw_module_methods_t cec_module_methods = {
|
|
.open = qhdmicec::cec_device_open
|
|
};
|
|
|
|
hdmi_module_t HAL_MODULE_INFO_SYM = {
|
|
.common = {
|
|
.tag = HARDWARE_MODULE_TAG,
|
|
.version_major = 1,
|
|
.version_minor = 0,
|
|
.id = HDMI_CEC_HARDWARE_MODULE_ID,
|
|
.name = "QTI HDMI CEC module",
|
|
.author = "The Linux Foundation",
|
|
.methods = &cec_module_methods,
|
|
}
|
|
};
|