NetBSD/sys/dev/i2c/ddc.c

141 lines
3.9 KiB
C

/* $NetBSD: ddc.c,v 1.9 2019/12/23 18:12:50 thorpej Exp $ */
/*-
* Copyright (c) 2006 Itronix Inc.
* All rights reserved.
*
* Written by Garrett D'Amore for Itronix Inc.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. 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.
* 3. The name of Itronix Inc. may not be used to endorse
* or promote products derived from this software without specific
* prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND ANY EXPRESS
* OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL ITRONIX INC. 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.
*/
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: ddc.c,v 1.9 2019/12/23 18:12:50 thorpej Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/kernel.h>
#include <sys/bus.h>
#include <dev/i2c/i2cvar.h>
#include <dev/i2c/ddcreg.h>
#include <dev/i2c/ddcvar.h>
/*
* VESA Display Data Channel I2C client, used to access EDID
* information.
*
* Note that this only supports DDC version 2, which uses normal I2C.
* The older DDCv1 standard used sync signaling to provide the I2C
* clock, and is typically not used on reasonably recent monitors.
*/
struct ddc_softc {
i2c_tag_t sc_tag;
int sc_address;
};
static int ddc_match(device_t, cfdata_t, void *);
static void ddc_attach(device_t, device_t, void *);
CFATTACH_DECL_NEW(ddc, sizeof (struct ddc_softc),
ddc_match, ddc_attach, NULL, NULL);
static int
ddc_match(device_t parent, cfdata_t cf, void *aux)
{
struct i2c_attach_args *ia = aux;
if (ia->ia_addr == DDC_ADDR)
return I2C_MATCH_ADDRESS_ONLY;
return 0;
}
static void
ddc_attach(device_t parent, device_t self, void *aux)
{
struct ddc_softc *sc = device_private(self);
struct i2c_attach_args *ia = aux;
sc->sc_tag = ia->ia_tag;
sc->sc_address = ia->ia_addr;
aprint_naive(": DDC\n");
aprint_normal(": DDC\n");
}
/* XXX: add cdev ops? */
int
ddc_read_edid(i2c_tag_t tag, uint8_t *dest, size_t len)
{
return ddc_read_edid_block(tag, dest, len, DDC_EDID_START);
}
int
ddc_read_edid_block(i2c_tag_t tag, uint8_t *dest, size_t len, uint8_t block)
{
uint8_t edid[256];
uint8_t wbuf[2];
int error;
if ((error = iic_acquire_bus(tag, 0)) != 0)
return error;
wbuf[0] = block >> 1; /* start address */
if ((error = iic_exec(tag, I2C_OP_READ_WITH_STOP, DDC_ADDR, wbuf, 1,
edid, sizeof(edid), 0)) != 0) {
iic_release_bus(tag, 0);
return error;
}
iic_release_bus(tag, 0);
if (block & 1) {
memcpy(dest, &edid[128], uimin(len, 128));
} else {
memcpy(dest, &edid[0], uimin(len, 128));
}
return 0;
}
int
ddc_dev_read_edid(device_t dev, uint8_t *dest, size_t len)
{
return ddc_dev_read_edid_block(dev, dest, len, DDC_EDID_START);
}
int
ddc_dev_read_edid_block(device_t dev, uint8_t *dest, size_t len, uint8_t block)
{
if (!device_is_a(dev, "ddc"))
return EINVAL;
const struct ddc_softc *sc = device_private(dev);
return ddc_read_edid_block(sc->sc_tag, dest, len, block);
}