#include "ddc_int.h"
#include "ddc.h"
#include "i2c.h"
#include <KernelExport.h>
#include <OS.h>
#include <stdlib.h>
#define READ_RETRIES 4
#define TRACE_DDC
#ifdef TRACE_DDC
extern void _sPrintf(const char* format, ...);
# define TRACE(x...) _sPrintf("DDC: " x)
#else
# define TRACE(x...) ;
#endif
static status_t
verify_checksum(const uint8 *data, size_t len)
{
uint32 index;
uint8 sum = 0;
uint8 allOr = 0;
for (index = 0; index < len; ++index, ++data) {
sum += *data;
allOr |= *data;
}
if (allOr == 0) {
TRACE("%s: DDC information contains zeros only\n", __func__);
return B_ERROR;
}
if (sum != 0) {
TRACE("%s: Checksum error in DDC information\n", __func__);
return B_IO_ERROR;
}
return B_OK;
}
static status_t
call_send_receive(const i2c_bus *bus, int slave_address,
const uint8 *writeBuffer, size_t writeLength, uint8 *readBuffer,
size_t readLength)
{
i2c_send_receive send_receive = bus->send_receive;
if (send_receive == NULL)
send_receive = i2c_send_receive_callback;
return send_receive(bus, slave_address, writeBuffer, writeLength, readBuffer,
readLength);
}
static status_t
ddc2_read(const i2c_bus *bus, int start, uint8 *buffer, size_t length)
{
status_t status = B_OK;
uint8 writeBuffer[2];
int i;
writeBuffer[0] = start & 0xff;
writeBuffer[1] = (start >> 8) & 0xff;
for (i = 0; i < READ_RETRIES; ++i) {
status = call_send_receive(bus, 0x50, writeBuffer,
start < 0x100 ? 1 : 2, buffer, length);
if (status != B_OK)
TRACE("%s: DDC information read failure\n", __func__);
if (status == B_OK) {
status = verify_checksum(buffer, length);
if (status == B_OK)
break;
dprintf("%s: DDC checksum incorrect!\n", __func__);
}
}
return status;
}
#if 0
static status_t
ddc2_read_vdif(const i2c_bus *bus, int start,
void **vdif, size_t *vdif_len)
{
status_t res;
uint8 *data, *cur_data;
int i;
uint8 buffer[64];
*vdif = NULL;
*vdif_len = 0;
res = ddc2_read(bus, start, buffer, 64);
SHOW_INFO(2, "%x", buffer[0]);
if (res != B_OK || buffer[0] == 0)
return B_OK;
data = malloc(buffer[0] * 63 + 1);
if (data == NULL)
return B_NO_MEMORY;
cur_data = data;
for (i = 0; i < buffer[0]; ++i) {
ddc2_read(bus, start + i * 64, cur_data, 64);
cur_data += 63;
}
*vdif_len = buffer[0] * 63;
*vdif = data;
return B_OK;
}
#endif
void
ddc2_init_timing(i2c_bus *bus)
{
bus->send_receive = NULL;
i2c_get100k_timing(&bus->timing);
bus->timing.start_timeout = 550;
bus->timing.byte_timeout = 2200;
bus->timing.bit_timeout = 40;
bus->timing.ack_start_timeout = 40;
bus->timing.ack_timeout = 40;
}
status_t
ddc2_read_edid1(const i2c_bus *bus, edid1_info *edid,
void **vdif, size_t *vdifLength)
{
edid1_raw raw;
status_t status = ddc2_read(bus, 0, (uint8 *)&raw, sizeof(raw));
if (status != B_OK)
return status;
if (raw.version.version != 1 || raw.version.revision > 4) {
TRACE("%s: EDID version or revision out of range\n", __func__);
return B_ERROR;
}
edid_decode(edid, &raw);
if (vdif != NULL)
*vdif = NULL;
if (vdifLength != NULL)
*vdifLength = 0;
#if 0
status = ddc2_read_vdif(bus, sizeof(raw) * (edid->num_sections + 1),
vdif, vdifLength);
if (status != B_OK)
return status;
#endif
return B_OK;
}