1 files changed, 149 insertions, 0 deletions
diff --git a/src/cec.c b/src/cec.c
new file mode 100644
index 0000000..d5125d9
--- /dev/null
+++ b/src/cec.c
@@ -0,0 +1,149 @@
+/*
+ * Copyright (C) ST-Ericsson SA 2011
+ * Author: Per Persson per.xb.persson@stericsson.com for
+ * ST-Ericsson.
+ * License terms: <FOSS license>.
+ */
+
+#include <unistd.h>     /* Symbolic Constants */
+#include <sys/types.h>  /* Primitive System Data Types */
+#include <errno.h>      /* Errors */
+#include <stdarg.h>
+#include <stdio.h>      /* Input/Output */
+#include <stdlib.h>     /* General Utilities */
+#include <string.h>     /* String handling */
+#include <fcntl.h>
+#include <time.h>
+#include <ctype.h>
+#include <utils/Log.h>
+#include "../include/hdmi_service_api.h"
+#include "../include/hdmi_service_local.h"
+
+const __u8 cecrxeven_val[] = {0x01}; /* Enable CEC RX events */
+int cectx_cmd_id;
+
+static int cectxcmdid_set(int cmd_id)
+{
+	cectx_cmd_id = cmd_id;
+	return 0;
+}
+
+static int cectxcmdid_get(void)
+{
+	return cectx_cmd_id;
+}
+
+/* Subscribe for incoming CEC messages */
+int cecrx_subscribe(void)
+{
+	int cecrxfd;
+
+	cecrxfd = open(CECRXEVEN_FILE, O_WRONLY);
+	if (cecrxfd < 0) {
+		LOGHDMILIB(" failed to open %s", CECRXEVEN_FILE);
+		return -1;
+	}
+	write(cecrxfd, cecrxeven_val, sizeof(cecrxeven_val));
+	close(cecrxfd);
+	return 0;
+}
+
+int cecsenderr(void)
+{
+	int val;
+	__u8 buf[32];
+	int cmd_id;
+
+	cmd_id = cectxcmdid_get();
+
+	val = HDMI_CECSENDERR;
+	memcpy(&buf[CMD_OFFSET], &val, 4);
+	memcpy(&buf[CMDID_OFFSET], &cmd_id, 4);
+	val = 0;
+	memcpy(&buf[CMDLEN_OFFSET], &val, 4);
+
+	/* Send on socket */
+	return clientsocket_send(buf, CMDBUF_OFFSET + val);
+}
+
+/* Send CEC message */
+int cecsend(__u32 cmd_id, __u8 in, __u8 dest, __u8 len, __u8 *data)
+{
+	int cecsendfd;
+	int res;
+	char buf[128];
+
+	LOGHDMILIB("%s begin", __func__);
+
+	cectxcmdid_set(cmd_id);
+
+	res = 0;
+	buf[0] = in;
+	buf[1] = dest;
+	buf[2] = len;
+	memcpy(&buf[3], data, len);
+
+	/* Send CEC cmd */
+	cecsendfd = open(CECSEND_FILE, O_WRONLY);
+	if (cecsendfd <= 0) {
+		LOGHDMILIB("***** Failed to open %s *****\n", CECSEND_FILE);
+		goto cecsend_err;
+	}
+
+	res = write(cecsendfd, buf, len + 3);
+	if (res != len + 3) {
+		LOGHDMILIB("***** cecsend failed %d *****\n", res);
+		close(cecsendfd);
+		goto cecsend_err;
+	}
+
+	close(cecsendfd);
+
+	LOGHDMILIB("%s end", __func__);
+	return 0;
+
+cecsend_err:
+	cecsenderr();
+	LOGHDMILIB("%s end", __func__);
+	return -1;
+}
+
+/* Read received CEC message and forward on client socket */
+int cecrx(void)
+{
+	int cecreadfd;
+	__u8 buf[32];
+	__u8 cecdata[32];
+	int cecsize;
+	int cnt;
+	int val;
+	int res = 0;
+	__u32 cmd_id;
+
+	LOGHDMILIB("%s begin", __func__);
+
+	cmd_id = get_new_cmd_id_ind();
+	cecreadfd = open(CECREAD_FILE, O_RDONLY);
+	if (cecreadfd < 0) {
+		LOGHDMILIB("***** Failed to open %s *****", CECREAD_FILE);
+		return -1;
+	}
+	cecsize = read(cecreadfd, buf, sizeof(buf));
+	close(cecreadfd);
+
+	for (cnt = 0; cnt < cecsize; cnt++)
+		LOGHDMILIB2("cecrx[%d]:%x", cnt, buf[cnt]);
+
+	val = HDMI_CECRECVD;
+	memcpy(&buf[CMD_OFFSET], &val, 4);
+	memcpy(&buf[CMDID_OFFSET], &cmd_id, 4);
+	val = cecsize;
+	memcpy(&buf[CMDLEN_OFFSET], &val, 4);
+	memcpy(&buf[CMDBUF_OFFSET], cecdata, val);
+
+	/* Send on socket */
+	res = clientsocket_send(buf, CMDBUF_OFFSET + val);
+
+	LOGHDMILIB("%s end", __func__);
+	return res;
+}