1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
|
/*
* Copyright
*
* Copyright (C) 2009-2010 Christian König (deathsimple@vodafone.de)
*
* License
*
* This program is free software; you can redistribute and/or modify
* program under the terms of GNU General Public license either version 3
* of the License, or (at your option) any later version.
*
*/
#include <stdint.h>
#include <stdio.h>
#include <string.h>
#include "cec.h"
static uint16_t device_type_addr[] = {
[CEC_TV] = 0xC001,
[CEC_Recording_Device] = 0x8206,
[CEC_Tuner] = 0x84C8,
[CEC_Playback_Device] = 0x8910,
[CEC_Audio_System] = 0x8020
};
static struct CEC_Physical_Address invalid_addr = {
.a = 0xF,
.b = 0xF,
.c = 0xF,
.d = 0xF
};
void CEC_Init_Device(struct CEC_Device* device)
{
if(!device) return;
device->logical_address = 0xF;
device->physical_address = invalid_addr;
device->func_debug = NULL;
int i;
for(i=0;i<0x100;i++)
device->func_handler[i] = NULL;
}
void CEC_Receive(struct CEC_Device* device)
{
if(!device || !device->hardware) return;
if(!device->hardware->func_receive) return;
struct CEC_Packet* packet = device->hardware->func_receive(device);
if(!packet) return;
if(device->func_debug) device->func_debug(CEC_RX_Packet, device, packet);
if(packet->length < 2) return;
void (*handler)(struct CEC_Device* device, struct CEC_Packet* packet);
handler = device->func_handler[packet->opcode];
if(handler) handler(device, packet);
}
int CEC_Transmit(struct CEC_Device* device, struct CEC_Packet* packet)
{
if(!device || !device->hardware) return 0;
if(!device->hardware->func_transmit) return 0;
int retransmit, result = 0;
for(retransmit=0; retransmit<5; retransmit++) {
if(device->hardware->func_transmit(device, packet)) {
result = 1;
break;
}
}
if(device->func_debug) {
device->func_debug(result ? CEC_TX_Sucess : CEC_TX_Failure, device, packet);
}
return result;
}
int CEC_Alloc_Addr(struct CEC_Device* device, enum CEC_Device_Type device_type)
{
uint16_t allowed = device_type_addr[device_type];
uint8_t addr;
if(!memcmp(&device->physical_address, &invalid_addr, sizeof(struct CEC_Physical_Address))) {
device->logical_address = 0xF;
return 0;
}
for(addr=0; addr<0xF; addr++) {
if(!(allowed & (1 << addr))) continue;
device->logical_address = addr;
if(!CEC_TX_Ping(device, addr)) break;
}
device->logical_address = addr;
return CEC_TX_Report_Physical_Address(device, device_type);
}
|