hw/core/register.c - qemu-android - Git at Google

 /*
  * Register Definition API
  *
  * Copyright (c) 2016 Xilinx Inc.
  * Copyright (c) 2013 Peter Crosthwaite <peter.crosthwaite@xilinx.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.
  */

 #include "qemu/osdep.h"
 #include "hw/register.h"
 #include "hw/qdev.h"
 #include "qemu/log.h"

 static inline void register_write_val(RegisterInfo *reg, uint64_t val)
 {
     g_assert(reg->data);

     switch (reg->data_size) {
     case 1:
         *(uint8_t *)reg->data = val;
         break;
     case 2:
         *(uint16_t *)reg->data = val;
         break;
     case 4:
         *(uint32_t *)reg->data = val;
         break;
     case 8:
         *(uint64_t *)reg->data = val;
         break;
     default:
         g_assert_not_reached();
     }
 }

 static inline uint64_t register_read_val(RegisterInfo *reg)
 {
     switch (reg->data_size) {
     case 1:
         return *(uint8_t *)reg->data;
     case 2:
         return *(uint16_t *)reg->data;
     case 4:
         return *(uint32_t *)reg->data;
     case 8:
         return *(uint64_t *)reg->data;
     default:
         g_assert_not_reached();
     }
     return 0; /* unreachable */
 }

 void register_write(RegisterInfo *reg, uint64_t val, uint64_t we,
                     const char *prefix, bool debug)
 {
     uint64_t old_val, new_val, test, no_w_mask;
     const RegisterAccessInfo *ac;

     assert(reg);

     ac = reg->access;

     if (!ac || !ac->name) {
         qemu_log_mask(LOG_GUEST_ERROR, "%s: write to undefined device state "
                       "(written value: %#" PRIx64 ")\n", prefix, val);
         return;
     }

     old_val = reg->data ? register_read_val(reg) : ac->reset;

     test = (old_val ^ val) & ac->rsvd;
     if (test) {
         qemu_log_mask(LOG_GUEST_ERROR, "%s: change of value in reserved bit"
                       "fields: %#" PRIx64 ")\n", prefix, test);
     }

     test = val & ac->unimp;
     if (test) {
         qemu_log_mask(LOG_UNIMP,
                       "%s:%s writing %#" PRIx64 " to unimplemented bits:" \
                       " %#" PRIx64 "",
                       prefix, reg->access->name, val, ac->unimp);
     }

     /* Create the no write mask based on the read only, write to clear and
      * reserved bit masks.
      */
     no_w_mask = ac->ro | ac->w1c | ac->rsvd | ~we;
     new_val = (val & ~no_w_mask) | (old_val & no_w_mask);
     new_val &= ~(val & ac->w1c);

     if (ac->pre_write) {
         new_val = ac->pre_write(reg, new_val);
     }

     if (debug) {
         qemu_log("%s:%s: write of value %#" PRIx64 "\n", prefix, ac->name,
                  new_val);
     }

     register_write_val(reg, new_val);

     if (ac->post_write) {
         ac->post_write(reg, new_val);
     }
 }

 uint64_t register_read(RegisterInfo *reg, uint64_t re, const char* prefix,
                        bool debug)
 {
     uint64_t ret;
     const RegisterAccessInfo *ac;

     assert(reg);

     ac = reg->access;
     if (!ac || !ac->name) {
         qemu_log_mask(LOG_GUEST_ERROR, "%s: read from undefined device state\n",
                       prefix);
         return 0;
     }

     ret = reg->data ? register_read_val(reg) : ac->reset;

     register_write_val(reg, ret & ~(ac->cor & re));

     /* Mask based on the read enable size */
     ret &= re;

     if (ac->post_read) {
         ret = ac->post_read(reg, ret);
     }

     if (debug) {
         qemu_log("%s:%s: read of value %#" PRIx64 "\n", prefix,
                  ac->name, ret);
     }

     return ret;
 }

 void register_reset(RegisterInfo *reg)
 {
     g_assert(reg);

     if (!reg->data || !reg->access) {
         return;
     }

     register_write_val(reg, reg->access->reset);
 }

 void register_init(RegisterInfo *reg)
 {
     assert(reg);

     if (!reg->data || !reg->access) {
         return;
     }

     object_initialize((void *)reg, sizeof(*reg), TYPE_REGISTER);
 }

 void register_write_memory(void *opaque, hwaddr addr,
                            uint64_t value, unsigned size)
 {
     RegisterInfoArray *reg_array = opaque;
     RegisterInfo *reg = NULL;
     uint64_t we;
     int i;

     for (i = 0; i < reg_array->num_elements; i++) {
         if (reg_array->r[i]->access->addr == addr) {
             reg = reg_array->r[i];
             break;
         }
     }

     if (!reg) {
         qemu_log_mask(LOG_GUEST_ERROR, "Write to unimplemented register at " \
                       "address: %#" PRIx64 "\n", addr);
         return;
     }

     /* Generate appropriate write enable mask */
     if (reg->data_size < size) {
         we = MAKE_64BIT_MASK(0, reg->data_size * 8);
     } else {
         we = MAKE_64BIT_MASK(0, size * 8);
     }

     register_write(reg, value, we, reg_array->prefix,
                    reg_array->debug);
 }

 uint64_t register_read_memory(void *opaque, hwaddr addr,
                               unsigned size)
 {
     RegisterInfoArray *reg_array = opaque;
     RegisterInfo *reg = NULL;
     uint64_t read_val;
     int i;

     for (i = 0; i < reg_array->num_elements; i++) {
         if (reg_array->r[i]->access->addr == addr) {
             reg = reg_array->r[i];
             break;
         }
     }

     if (!reg) {
         qemu_log_mask(LOG_GUEST_ERROR, "Read to unimplemented register at " \
                       "address: %#" PRIx64 "\n", addr);
         return 0;
     }

     read_val = register_read(reg, size * 8, reg_array->prefix,
                              reg_array->debug);

     return extract64(read_val, 0, size * 8);
 }

 RegisterInfoArray *register_init_block32(DeviceState *owner,
                                          const RegisterAccessInfo *rae,
                                          int num, RegisterInfo *ri,
                                          uint32_t *data,
                                          const MemoryRegionOps *ops,
                                          bool debug_enabled,
                                          uint64_t memory_size)
 {
     const char *device_prefix = object_get_typename(OBJECT(owner));
     RegisterInfoArray *r_array = g_new0(RegisterInfoArray, 1);
     int i;

     r_array->r = g_new0(RegisterInfo *, num);
     r_array->num_elements = num;
     r_array->debug = debug_enabled;
     r_array->prefix = device_prefix;

     for (i = 0; i < num; i++) {
         int index = rae[i].addr / 4;
         RegisterInfo *r = &ri[index];

         *r = (RegisterInfo) {
             .data = &data[index],
             .data_size = sizeof(uint32_t),
             .access = &rae[i],
             .opaque = owner,
         };
         register_init(r);

         r_array->r[i] = r;
     }

     memory_region_init_io(&r_array->mem, OBJECT(owner), ops, r_array,
                           device_prefix, memory_size);

     return r_array;
 }

 void register_finalize_block(RegisterInfoArray *r_array)
 {
     object_unparent(OBJECT(&r_array->mem));
     g_free(r_array->r);
     g_free(r_array);
 }

 static const TypeInfo register_info = {
     .name  = TYPE_REGISTER,
     .parent = TYPE_DEVICE,
 };

 static void register_register_types(void)
 {
     type_register_static(&register_info);
 }

 type_init(register_register_types)
	/*
	* Register Definition API
	*
	* Copyright (c) 2016 Xilinx Inc.
	* Copyright (c) 2013 Peter Crosthwaite <peter.crosthwaite@xilinx.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.
	*/

	#include "qemu/osdep.h"
	#include "hw/register.h"
	#include "hw/qdev.h"
	#include "qemu/log.h"

	static inline void register_write_val(RegisterInfo *reg, uint64_t val)
	{
	g_assert(reg->data);

	switch (reg->data_size) {
	case 1:
	(uint8_t )reg->data = val;
	break;
	case 2:
	(uint16_t )reg->data = val;
	break;
	case 4:
	(uint32_t )reg->data = val;
	break;
	case 8:
	(uint64_t )reg->data = val;
	break;
	default:
	g_assert_not_reached();
	}
	}

	static inline uint64_t register_read_val(RegisterInfo *reg)
	{
	switch (reg->data_size) {
	case 1:
	return (uint8_t )reg->data;
	case 2:
	return (uint16_t )reg->data;
	case 4:
	return (uint32_t )reg->data;
	case 8:
	return (uint64_t )reg->data;
	default:
	g_assert_not_reached();
	}
	return 0; /* unreachable */
	}

	void register_write(RegisterInfo *reg, uint64_t val, uint64_t we,
	const char *prefix, bool debug)
	{
	uint64_t old_val, new_val, test, no_w_mask;
	const RegisterAccessInfo *ac;

	assert(reg);

	ac = reg->access;

	if (!ac \|\| !ac->name) {
	qemu_log_mask(LOG_GUEST_ERROR, "%s: write to undefined device state "
	"(written value: %#" PRIx64 ")\n", prefix, val);
	return;
	}

	old_val = reg->data ? register_read_val(reg) : ac->reset;

	test = (old_val ^ val) & ac->rsvd;
	if (test) {
	qemu_log_mask(LOG_GUEST_ERROR, "%s: change of value in reserved bit"
	"fields: %#" PRIx64 ")\n", prefix, test);
	}

	test = val & ac->unimp;
	if (test) {
	qemu_log_mask(LOG_UNIMP,
	"%s:%s writing %#" PRIx64 " to unimplemented bits:" \
	" %#" PRIx64 "",
	prefix, reg->access->name, val, ac->unimp);
	}

	/* Create the no write mask based on the read only, write to clear and
	* reserved bit masks.
	*/
	no_w_mask = ac->ro \| ac->w1c \| ac->rsvd \| ~we;
	new_val = (val & ~no_w_mask) \| (old_val & no_w_mask);
	new_val &= ~(val & ac->w1c);

	if (ac->pre_write) {
	new_val = ac->pre_write(reg, new_val);
	}

	if (debug) {
	qemu_log("%s:%s: write of value %#" PRIx64 "\n", prefix, ac->name,
	new_val);
	}

	register_write_val(reg, new_val);

	if (ac->post_write) {
	ac->post_write(reg, new_val);
	}
	}

	uint64_t register_read(RegisterInfo reg, uint64_t re, const char prefix,
	bool debug)
	{
	uint64_t ret;
	const RegisterAccessInfo *ac;

	assert(reg);

	ac = reg->access;
	if (!ac \|\| !ac->name) {
	qemu_log_mask(LOG_GUEST_ERROR, "%s: read from undefined device state\n",
	prefix);
	return 0;
	}

	ret = reg->data ? register_read_val(reg) : ac->reset;

	register_write_val(reg, ret & ~(ac->cor & re));

	/* Mask based on the read enable size */
	ret &= re;

	if (ac->post_read) {
	ret = ac->post_read(reg, ret);
	}

	if (debug) {
	qemu_log("%s:%s: read of value %#" PRIx64 "\n", prefix,
	ac->name, ret);
	}

	return ret;
	}

	void register_reset(RegisterInfo *reg)
	{
	g_assert(reg);

	if (!reg->data \|\| !reg->access) {
	return;
	}

	register_write_val(reg, reg->access->reset);
	}

	void register_init(RegisterInfo *reg)
	{
	assert(reg);

	if (!reg->data \|\| !reg->access) {
	return;
	}

	object_initialize((void )reg, sizeof(reg), TYPE_REGISTER);
	}

	void register_write_memory(void *opaque, hwaddr addr,
	uint64_t value, unsigned size)
	{
	RegisterInfoArray *reg_array = opaque;
	RegisterInfo *reg = NULL;
	uint64_t we;
	int i;

	for (i = 0; i < reg_array->num_elements; i++) {
	if (reg_array->r[i]->access->addr == addr) {
	reg = reg_array->r[i];
	break;
	}
	}

	if (!reg) {
	qemu_log_mask(LOG_GUEST_ERROR, "Write to unimplemented register at " \
	"address: %#" PRIx64 "\n", addr);
	return;
	}

	/* Generate appropriate write enable mask */
	if (reg->data_size < size) {
	we = MAKE_64BIT_MASK(0, reg->data_size * 8);
	} else {
	we = MAKE_64BIT_MASK(0, size * 8);
	}

	register_write(reg, value, we, reg_array->prefix,
	reg_array->debug);
	}

	uint64_t register_read_memory(void *opaque, hwaddr addr,
	unsigned size)
	{
	RegisterInfoArray *reg_array = opaque;
	RegisterInfo *reg = NULL;
	uint64_t read_val;
	int i;

	for (i = 0; i < reg_array->num_elements; i++) {
	if (reg_array->r[i]->access->addr == addr) {
	reg = reg_array->r[i];
	break;
	}
	}

	if (!reg) {
	qemu_log_mask(LOG_GUEST_ERROR, "Read to unimplemented register at " \
	"address: %#" PRIx64 "\n", addr);
	return 0;
	}

	read_val = register_read(reg, size * 8, reg_array->prefix,
	reg_array->debug);

	return extract64(read_val, 0, size * 8);
	}

	RegisterInfoArray register_init_block32(DeviceState owner,
	const RegisterAccessInfo *rae,
	int num, RegisterInfo *ri,
	uint32_t *data,
	const MemoryRegionOps *ops,
	bool debug_enabled,
	uint64_t memory_size)
	{
	const char *device_prefix = object_get_typename(OBJECT(owner));
	RegisterInfoArray *r_array = g_new0(RegisterInfoArray, 1);
	int i;

	r_array->r = g_new0(RegisterInfo *, num);
	r_array->num_elements = num;
	r_array->debug = debug_enabled;
	r_array->prefix = device_prefix;

	for (i = 0; i < num; i++) {
	int index = rae[i].addr / 4;
	RegisterInfo *r = &ri[index];

	*r = (RegisterInfo) {
	.data = &data[index],
	.data_size = sizeof(uint32_t),
	.access = &rae[i],
	.opaque = owner,
	};
	register_init(r);

	r_array->r[i] = r;
	}

	memory_region_init_io(&r_array->mem, OBJECT(owner), ops, r_array,
	device_prefix, memory_size);

	return r_array;
	}

	void register_finalize_block(RegisterInfoArray *r_array)
	{
	object_unparent(OBJECT(&r_array->mem));
	g_free(r_array->r);
	g_free(r_array);
	}

	static const TypeInfo register_info = {
	.name = TYPE_REGISTER,
	.parent = TYPE_DEVICE,
	};

	static void register_register_types(void)
	{
	type_register_static(&register_info);
	}

	type_init(register_register_types)