174 lines
		
	
	
		
			5.0 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			174 lines
		
	
	
		
			5.0 KiB
		
	
	
	
		
			C
		
	
	
	
/*
 | 
						|
 * dpcd.c
 | 
						|
 *
 | 
						|
 *  Copyright (C) 2015 : GreenSocs Ltd
 | 
						|
 *      http://www.greensocs.com/ , email: info@greensocs.com
 | 
						|
 *
 | 
						|
 *  Developed by :
 | 
						|
 *  Frederic Konrad   <fred.konrad@greensocs.com>
 | 
						|
 *
 | 
						|
 * This program is free software; you can redistribute it and/or modify
 | 
						|
 * it under the terms of the GNU General Public License as published by
 | 
						|
 * the Free Software Foundation, either version 2 of the License, or
 | 
						|
 * (at your option)any later version.
 | 
						|
 *
 | 
						|
 * This program is distributed in the hope that it will be useful,
 | 
						|
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
						|
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 | 
						|
 * GNU General Public License for more details.
 | 
						|
 *
 | 
						|
 * You should have received a copy of the GNU General Public License along
 | 
						|
 * with this program; if not, see <http://www.gnu.org/licenses/>.
 | 
						|
 *
 | 
						|
 */
 | 
						|
 | 
						|
/*
 | 
						|
 * This is a simple AUX slave which emulates a connected screen.
 | 
						|
 */
 | 
						|
 | 
						|
#include "qemu/osdep.h"
 | 
						|
#include "qemu/log.h"
 | 
						|
#include "hw/misc/auxbus.h"
 | 
						|
#include "hw/display/dpcd.h"
 | 
						|
 | 
						|
#ifndef DEBUG_DPCD
 | 
						|
#define DEBUG_DPCD 0
 | 
						|
#endif
 | 
						|
 | 
						|
#define DPRINTF(fmt, ...) do {                                                 \
 | 
						|
    if (DEBUG_DPCD) {                                                          \
 | 
						|
        qemu_log("dpcd: " fmt, ## __VA_ARGS__);                                \
 | 
						|
    }                                                                          \
 | 
						|
} while (0);
 | 
						|
 | 
						|
#define DPCD_READABLE_AREA                      0x600
 | 
						|
 | 
						|
struct DPCDState {
 | 
						|
    /*< private >*/
 | 
						|
    AUXSlave parent_obj;
 | 
						|
 | 
						|
    /*< public >*/
 | 
						|
    /*
 | 
						|
     * The DCPD is 0x7FFFF length but read as 0 after offset 0x5FF.
 | 
						|
     */
 | 
						|
    uint8_t dpcd_info[DPCD_READABLE_AREA];
 | 
						|
 | 
						|
    MemoryRegion iomem;
 | 
						|
};
 | 
						|
 | 
						|
static uint64_t dpcd_read(void *opaque, hwaddr offset, unsigned size)
 | 
						|
{
 | 
						|
    uint8_t ret;
 | 
						|
    DPCDState *e = DPCD(opaque);
 | 
						|
 | 
						|
    if (offset < DPCD_READABLE_AREA) {
 | 
						|
        ret = e->dpcd_info[offset];
 | 
						|
    } else {
 | 
						|
        qemu_log_mask(LOG_GUEST_ERROR, "dpcd: Bad offset 0x%" HWADDR_PRIX "\n",
 | 
						|
                                       offset);
 | 
						|
        ret = 0;
 | 
						|
    }
 | 
						|
 | 
						|
    DPRINTF("read 0x%" PRIX8 " @0x%" HWADDR_PRIX "\n", ret, offset);
 | 
						|
    return ret;
 | 
						|
}
 | 
						|
 | 
						|
static void dpcd_write(void *opaque, hwaddr offset, uint64_t value,
 | 
						|
                       unsigned size)
 | 
						|
{
 | 
						|
    DPCDState *e = DPCD(opaque);
 | 
						|
 | 
						|
    DPRINTF("write 0x%" PRIX8 " @0x%" HWADDR_PRIX "\n", (uint8_t)value, offset);
 | 
						|
 | 
						|
    if (offset < DPCD_READABLE_AREA) {
 | 
						|
        e->dpcd_info[offset] = value;
 | 
						|
    } else {
 | 
						|
        qemu_log_mask(LOG_GUEST_ERROR, "dpcd: Bad offset 0x%" HWADDR_PRIX "\n",
 | 
						|
                                       offset);
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
static const MemoryRegionOps aux_ops = {
 | 
						|
    .read = dpcd_read,
 | 
						|
    .write = dpcd_write,
 | 
						|
    .valid = {
 | 
						|
        .min_access_size = 1,
 | 
						|
        .max_access_size = 1,
 | 
						|
    },
 | 
						|
    .impl = {
 | 
						|
        .min_access_size = 1,
 | 
						|
        .max_access_size = 1,
 | 
						|
    },
 | 
						|
};
 | 
						|
 | 
						|
static void dpcd_reset(DeviceState *dev)
 | 
						|
{
 | 
						|
    DPCDState *s = DPCD(dev);
 | 
						|
 | 
						|
    memset(&(s->dpcd_info), 0, sizeof(s->dpcd_info));
 | 
						|
 | 
						|
    s->dpcd_info[DPCD_REVISION] = DPCD_REV_1_0;
 | 
						|
    s->dpcd_info[DPCD_MAX_LINK_RATE] = DPCD_5_4GBPS;
 | 
						|
    s->dpcd_info[DPCD_MAX_LANE_COUNT] = DPCD_FOUR_LANES;
 | 
						|
    s->dpcd_info[DPCD_RECEIVE_PORT0_CAP_0] = DPCD_EDID_PRESENT;
 | 
						|
    /* buffer size */
 | 
						|
    s->dpcd_info[DPCD_RECEIVE_PORT0_CAP_1] = 0xFF;
 | 
						|
 | 
						|
    s->dpcd_info[DPCD_LANE0_1_STATUS] = DPCD_LANE0_CR_DONE
 | 
						|
                                      | DPCD_LANE0_CHANNEL_EQ_DONE
 | 
						|
                                      | DPCD_LANE0_SYMBOL_LOCKED
 | 
						|
                                      | DPCD_LANE1_CR_DONE
 | 
						|
                                      | DPCD_LANE1_CHANNEL_EQ_DONE
 | 
						|
                                      | DPCD_LANE1_SYMBOL_LOCKED;
 | 
						|
    s->dpcd_info[DPCD_LANE2_3_STATUS] = DPCD_LANE2_CR_DONE
 | 
						|
                                      | DPCD_LANE2_CHANNEL_EQ_DONE
 | 
						|
                                      | DPCD_LANE2_SYMBOL_LOCKED
 | 
						|
                                      | DPCD_LANE3_CR_DONE
 | 
						|
                                      | DPCD_LANE3_CHANNEL_EQ_DONE
 | 
						|
                                      | DPCD_LANE3_SYMBOL_LOCKED;
 | 
						|
 | 
						|
    s->dpcd_info[DPCD_LANE_ALIGN_STATUS_UPDATED] = DPCD_INTERLANE_ALIGN_DONE;
 | 
						|
    s->dpcd_info[DPCD_SINK_STATUS] = DPCD_RECEIVE_PORT_0_STATUS;
 | 
						|
}
 | 
						|
 | 
						|
static void dpcd_init(Object *obj)
 | 
						|
{
 | 
						|
    DPCDState *s = DPCD(obj);
 | 
						|
 | 
						|
    memory_region_init_io(&s->iomem, obj, &aux_ops, s, TYPE_DPCD, 0x7FFFF);
 | 
						|
    aux_init_mmio(AUX_SLAVE(obj), &s->iomem);
 | 
						|
}
 | 
						|
 | 
						|
static const VMStateDescription vmstate_dpcd = {
 | 
						|
    .name = TYPE_DPCD,
 | 
						|
    .version_id = 0,
 | 
						|
    .minimum_version_id = 0,
 | 
						|
    .fields = (VMStateField[]) {
 | 
						|
        VMSTATE_UINT8_ARRAY_V(dpcd_info, DPCDState, DPCD_READABLE_AREA, 0),
 | 
						|
        VMSTATE_END_OF_LIST()
 | 
						|
    }
 | 
						|
};
 | 
						|
 | 
						|
static void dpcd_class_init(ObjectClass *oc, void *data)
 | 
						|
{
 | 
						|
    DeviceClass *dc = DEVICE_CLASS(oc);
 | 
						|
 | 
						|
    dc->reset = dpcd_reset;
 | 
						|
    dc->vmsd = &vmstate_dpcd;
 | 
						|
}
 | 
						|
 | 
						|
static const TypeInfo dpcd_info = {
 | 
						|
    .name          = TYPE_DPCD,
 | 
						|
    .parent        = TYPE_AUX_SLAVE,
 | 
						|
    .instance_size = sizeof(DPCDState),
 | 
						|
    .class_init    = dpcd_class_init,
 | 
						|
    .instance_init = dpcd_init,
 | 
						|
};
 | 
						|
 | 
						|
static void dpcd_register_types(void)
 | 
						|
{
 | 
						|
    type_register_static(&dpcd_info);
 | 
						|
}
 | 
						|
 | 
						|
type_init(dpcd_register_types)
 |