0a13382c8e
erc32 PR 18273 * sis.c (main): Remove unreachable code. m68hc11 * gencode.c (gen_fetch_operands): Remove unreachable code. ppc * hw_htab.c (htab_map_binary): Fix overlap check. common * sim-fpu.c (INLINE_SIM_FPU): Fix static analysis warning by increasing parenthesis around casts to signed values.
691 lines
21 KiB
C
691 lines
21 KiB
C
/* This file is part of the program psim.
|
|
|
|
Copyright 1994, 1995, 1996, 2003, 2004 Andrew Cagney
|
|
|
|
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 3 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/>.
|
|
|
|
*/
|
|
|
|
|
|
#ifndef _HW_HTAB_C_
|
|
#define _HW_HTAB_C_
|
|
|
|
#include "device_table.h"
|
|
#include "device.h"
|
|
|
|
#include "bfd.h"
|
|
|
|
|
|
/* DEVICE
|
|
|
|
|
|
htab - pseudo-device describing a PowerPC hash table
|
|
|
|
|
|
DESCRIPTION
|
|
|
|
|
|
During the initialization of the device tree, the pseudo-device
|
|
<<htab>>, in conjunction with any child <<pte>> pseudo-devices,
|
|
will create a PowerPC hash table in memory. The hash table values
|
|
are written using dma transfers.
|
|
|
|
The size and address of the hash table are determined by properties
|
|
of the htab node.
|
|
|
|
By convention, the htab device is made a child of the
|
|
<</openprom/init>> node.
|
|
|
|
By convention, the real address of the htab is used as the htab
|
|
nodes unit address.
|
|
|
|
|
|
PROPERTIES
|
|
|
|
|
|
real-address = <address> (required)
|
|
|
|
The physical address of the hash table. The PowerPC architecture
|
|
places limitations on what is a valid hash table real-address.
|
|
|
|
|
|
nr-bytes = <size> (required)
|
|
|
|
The size of the hash table (in bytes) that is to be created at
|
|
<<real-address>>. The PowerPC architecture places limitations on
|
|
what is a valid hash table size.
|
|
|
|
|
|
claim = <anything> (optional)
|
|
|
|
If this property is present, the memory used to construct the hash
|
|
table will be claimed from the memory device. The memory device
|
|
being specified by the <</chosen/memory>> ihandle property.
|
|
|
|
|
|
EXAMPLES
|
|
|
|
Enable tracing.
|
|
|
|
| $ psim -t htab-device \
|
|
|
|
|
|
Create a htab specifying the base address and minimum size.
|
|
|
|
| -o '/openprom/init/htab@0x10000/real-address 0x10000' \
|
|
| -o '/openprom/init/htab@0x10000/claim 0' \
|
|
| -o '/openprom/init/htab@0x10000/nr-bytes 65536' \
|
|
|
|
|
|
BUGS
|
|
|
|
|
|
See the <<pte>> device.
|
|
|
|
|
|
*/
|
|
|
|
|
|
/* DEVICE
|
|
|
|
|
|
pte - pseudo-device describing a htab entry
|
|
|
|
|
|
DESCRIPTION
|
|
|
|
|
|
The <<pte>> pseudo-device, which must be a child of a <<htabl>>
|
|
node, describes a virtual to physical mapping that is to be entered
|
|
into the parents hash table.
|
|
|
|
Two alternative specifications of the mapping are allowed. Either
|
|
a section of physical memory can be mapped to a virtual address, or
|
|
the header of an executible image can be used to define the
|
|
mapping.
|
|
|
|
By convention, the real address of the map is specified as the pte
|
|
devices unit address.
|
|
|
|
|
|
PROPERTIES
|
|
|
|
|
|
real-address = <address> (required)
|
|
|
|
The starting physical address that is to be mapped by the hash
|
|
table.
|
|
|
|
|
|
wimg = <int> (required)
|
|
pp = <int> (required)
|
|
|
|
The value of hash table protection bits that are to be used when
|
|
creating the virtual to physical address map.
|
|
|
|
|
|
claim = <anything> (optional)
|
|
|
|
If this property is present, the real memory that is being mapped by the
|
|
hash table will be claimed from the memory node (specified by the
|
|
ihandle <</chosen/memory>>).
|
|
|
|
|
|
virtual-address = <integer> [ <integer> ] (option A)
|
|
nr-bytes = <size> (option A)
|
|
|
|
Option A - Virtual virtual address (and size) at which the physical
|
|
address is to be mapped. If multiple values are specified for the
|
|
virtual address then they are concatenated to gether to form a
|
|
longer virtual address.
|
|
|
|
|
|
file-name = <string> (option B)
|
|
|
|
Option B - An executable image that is to be loaded (starting at
|
|
the physical address specified above) and then mapped in using
|
|
informatioin taken from the executables header. information found
|
|
in the files header.
|
|
|
|
|
|
EXAMPLES
|
|
|
|
|
|
Enable tracing (note that both the <<htab>> and <<pte>> device use the
|
|
same trace option).
|
|
|
|
| -t htab-device \
|
|
|
|
|
|
Map a block of physical memory into a specified virtual address:
|
|
|
|
| -o '/openprom/init/htab/pte@0x0/real-address 0' \
|
|
| -o '/openprom/init/htab/pte@0x0/nr-bytes 4096' \
|
|
| -o '/openprom/init/htab/pte@0x0/virtual-address 0x1000000' \
|
|
| -o '/openprom/init/htab/pte@0x0/claim 0' \
|
|
| -o '/openprom/init/htab/pte@0x0/wimg 0x7' \
|
|
| -o '/openprom/init/htab/pte@0x0/pp 0x2' \
|
|
|
|
|
|
Map a file into memory.
|
|
|
|
| -o '/openprom/init/htab/pte@0x10000/real-address 0x10000' \
|
|
| -o '/openprom/init/htab/pte@0x10000/file-name "netbsd.elf' \
|
|
| -o '/openprom/init/htab/pte@0x10000/wimg 0x7' \
|
|
| -o '/openprom/init/htab/pte@0x10000/pp 0x2' \
|
|
|
|
|
|
BUGS
|
|
|
|
|
|
For an ELF executable, the header defines both the virtual and real
|
|
address at which each file section should be loaded. At present, the
|
|
real addresses that are specified in the header are ignored, the file
|
|
instead being loaded in to physical memory in a linear fashion.
|
|
|
|
When claiming memory, this device assumes that the #address-cells
|
|
and #size-cells is one. For future implementations, this may not
|
|
be the case.
|
|
|
|
*/
|
|
|
|
|
|
|
|
static void
|
|
htab_decode_hash_table(device *me,
|
|
unsigned32 *htaborg,
|
|
unsigned32 *htabmask)
|
|
{
|
|
unsigned_word htab_ra;
|
|
unsigned htab_nr_bytes;
|
|
unsigned n;
|
|
device *parent = device_parent(me);
|
|
/* determine the location/size of the hash table */
|
|
if (parent == NULL
|
|
|| strcmp(device_name(parent), "htab") != 0)
|
|
device_error(parent, "must be a htab device");
|
|
htab_ra = device_find_integer_property(parent, "real-address");
|
|
htab_nr_bytes = device_find_integer_property(parent, "nr-bytes");
|
|
if (htab_nr_bytes < 0x10000) {
|
|
device_error(parent, "htab size 0x%x less than 0x1000",
|
|
htab_nr_bytes);
|
|
}
|
|
for (n = htab_nr_bytes; n > 1; n = n / 2) {
|
|
if (n % 2 != 0)
|
|
device_error(parent, "htab size 0x%x not a power of two",
|
|
htab_nr_bytes);
|
|
}
|
|
*htaborg = htab_ra;
|
|
/* Position the HTABMASK ready for use against a hashed address and
|
|
not ready for insertion into SDR1.HTABMASK. */
|
|
*htabmask = MASKED32(htab_nr_bytes - 1, 7, 31-6);
|
|
/* Check that the MASK and ADDRESS do not overlap. */
|
|
if ((htab_ra & (*htabmask)) != 0) {
|
|
device_error(parent, "htaborg 0x%lx not aligned to htabmask 0x%lx",
|
|
(unsigned long)*htaborg, (unsigned long)*htabmask);
|
|
}
|
|
DTRACE(htab, ("htab - htaborg=0x%lx htabmask=0x%lx\n",
|
|
(unsigned long)*htaborg, (unsigned long)*htabmask));
|
|
}
|
|
|
|
static void
|
|
htab_map_page(device *me,
|
|
unsigned_word ra,
|
|
unsigned64 va,
|
|
unsigned wimg,
|
|
unsigned pp,
|
|
unsigned32 htaborg,
|
|
unsigned32 htabmask)
|
|
{
|
|
/* keep everything left shifted so that the numbering is easier */
|
|
unsigned64 vpn = va << 12;
|
|
unsigned32 vsid = INSERTED32(EXTRACTED64(vpn, 0, 23), 0, 23);
|
|
unsigned32 vpage = INSERTED32(EXTRACTED64(vpn, 24, 39), 0, 15);
|
|
unsigned32 hash = INSERTED32(EXTRACTED32(vsid, 5, 23)
|
|
^ EXTRACTED32(vpage, 0, 15),
|
|
7, 31-6);
|
|
int h;
|
|
for (h = 0; h < 2; h++) {
|
|
unsigned32 pteg = (htaborg | (hash & htabmask));
|
|
int pti;
|
|
for (pti = 0; pti < 8; pti++) {
|
|
unsigned32 pte = pteg + 8 * pti;
|
|
unsigned32 current_target_pte0;
|
|
unsigned32 current_pte0;
|
|
if (device_dma_read_buffer(device_parent(me),
|
|
¤t_target_pte0,
|
|
0, /*space*/
|
|
pte,
|
|
sizeof(current_target_pte0)) != 4)
|
|
device_error(me, "failed to read a pte at 0x%lx", (unsigned long)pte);
|
|
current_pte0 = T2H_4(current_target_pte0);
|
|
if (MASKED32(current_pte0, 0, 0)) {
|
|
/* full pte, check it isn't already mapping the same virtual
|
|
address */
|
|
unsigned32 curr_vsid = INSERTED32(EXTRACTED32(current_pte0, 1, 24), 0, 23);
|
|
unsigned32 curr_api = INSERTED32(EXTRACTED32(current_pte0, 26, 31), 0, 5);
|
|
unsigned32 curr_h = EXTRACTED32(current_pte0, 25, 25);
|
|
if (curr_h == h
|
|
&& curr_vsid == vsid
|
|
&& curr_api == MASKED32(vpage, 0, 5))
|
|
device_error(me, "duplicate map - va=0x%08lx ra=0x%lx vsid=0x%lx h=%d vpage=0x%lx hash=0x%lx pteg=0x%lx+%2d pte0=0x%lx",
|
|
(unsigned long)va,
|
|
(unsigned long)ra,
|
|
(unsigned long)vsid,
|
|
h,
|
|
(unsigned long)vpage,
|
|
(unsigned long)hash,
|
|
(unsigned long)pteg,
|
|
pti * 8,
|
|
(unsigned long)current_pte0);
|
|
}
|
|
else {
|
|
/* empty pte fill it */
|
|
unsigned32 pte0 = (MASK32(0, 0)
|
|
| INSERTED32(EXTRACTED32(vsid, 0, 23), 1, 24)
|
|
| INSERTED32(h, 25, 25)
|
|
| INSERTED32(EXTRACTED32(vpage, 0, 5), 26, 31));
|
|
unsigned32 target_pte0 = H2T_4(pte0);
|
|
unsigned32 pte1 = (INSERTED32(EXTRACTED32(ra, 0, 19), 0, 19)
|
|
| INSERTED32(wimg, 25, 28)
|
|
| INSERTED32(pp, 30, 31));
|
|
unsigned32 target_pte1 = H2T_4(pte1);
|
|
if (device_dma_write_buffer(device_parent(me),
|
|
&target_pte0,
|
|
0, /*space*/
|
|
pte,
|
|
sizeof(target_pte0),
|
|
1/*ro?*/) != 4
|
|
|| device_dma_write_buffer(device_parent(me),
|
|
&target_pte1,
|
|
0, /*space*/
|
|
pte + 4,
|
|
sizeof(target_pte1),
|
|
1/*ro?*/) != 4)
|
|
device_error(me, "failed to write a pte a 0x%lx", (unsigned long)pte);
|
|
DTRACE(htab, ("map - va=0x%08lx ra=0x%lx vsid=0x%lx h=%d vpage=0x%lx hash=0x%lx pteg=0x%lx+%2d pte0=0x%lx pte1=0x%lx\n",
|
|
(unsigned long)va,
|
|
(unsigned long)ra,
|
|
(unsigned long)vsid,
|
|
h,
|
|
(unsigned long)vpage,
|
|
(unsigned long)hash,
|
|
(unsigned long)pteg,
|
|
pti * 8,
|
|
(unsigned long)pte0,
|
|
(unsigned long)pte1));
|
|
return;
|
|
}
|
|
}
|
|
/* re-hash */
|
|
hash = MASKED32(~hash, 0, 18);
|
|
}
|
|
}
|
|
|
|
static unsigned_word
|
|
claim_memory(device *me,
|
|
device_instance *memory,
|
|
unsigned_word ra,
|
|
unsigned_word size)
|
|
{
|
|
unsigned32 args[3];
|
|
unsigned32 results[1];
|
|
int status;
|
|
args[0] = 0; /* alignment */
|
|
args[1] = size;
|
|
args[2] = ra;
|
|
status = device_instance_call_method(memory, "claim", 3, args, 1, results);
|
|
if (status != 0)
|
|
device_error(me, "failed to claim memory");
|
|
return results[0];
|
|
}
|
|
|
|
static void
|
|
htab_map_region(device *me,
|
|
device_instance *memory,
|
|
unsigned_word pte_ra,
|
|
unsigned64 pte_va,
|
|
unsigned nr_bytes,
|
|
unsigned wimg,
|
|
unsigned pp,
|
|
unsigned32 htaborg,
|
|
unsigned32 htabmask)
|
|
{
|
|
unsigned_word ra;
|
|
unsigned64 va;
|
|
/* claim the memory */
|
|
if (memory != NULL)
|
|
claim_memory(me, memory, pte_ra, nr_bytes);
|
|
/* go through all pages and create a pte for each */
|
|
for (ra = pte_ra, va = pte_va;
|
|
ra < pte_ra + nr_bytes;
|
|
ra += 0x1000, va += 0x1000) {
|
|
htab_map_page(me, ra, va, wimg, pp, htaborg, htabmask);
|
|
}
|
|
}
|
|
|
|
typedef struct _htab_binary_sizes {
|
|
unsigned_word text_ra;
|
|
unsigned_word text_base;
|
|
unsigned_word text_bound;
|
|
unsigned_word data_ra;
|
|
unsigned_word data_base;
|
|
unsigned data_bound;
|
|
device *me;
|
|
} htab_binary_sizes;
|
|
|
|
static void
|
|
htab_sum_binary(bfd *abfd,
|
|
sec_ptr sec,
|
|
PTR data)
|
|
{
|
|
htab_binary_sizes *sizes = (htab_binary_sizes*)data;
|
|
unsigned_word size = bfd_get_section_size (sec);
|
|
unsigned_word vma = bfd_get_section_vma (abfd, sec);
|
|
unsigned_word ra = bfd_get_section_lma (abfd, sec);
|
|
|
|
/* skip the section if no memory to allocate */
|
|
if (! (bfd_get_section_flags(abfd, sec) & SEC_ALLOC))
|
|
return;
|
|
|
|
if ((bfd_get_section_flags (abfd, sec) & SEC_CODE)
|
|
|| (bfd_get_section_flags (abfd, sec) & SEC_READONLY)) {
|
|
if (sizes->text_bound < vma + size)
|
|
sizes->text_bound = ALIGN_PAGE(vma + size);
|
|
if (sizes->text_base > vma)
|
|
sizes->text_base = FLOOR_PAGE(vma);
|
|
if (sizes->text_ra > ra)
|
|
sizes->text_ra = FLOOR_PAGE(ra);
|
|
}
|
|
else if ((bfd_get_section_flags (abfd, sec) & SEC_DATA)
|
|
|| (bfd_get_section_flags (abfd, sec) & SEC_ALLOC)) {
|
|
if (sizes->data_bound < vma + size)
|
|
sizes->data_bound = ALIGN_PAGE(vma + size);
|
|
if (sizes->data_base > vma)
|
|
sizes->data_base = FLOOR_PAGE(vma);
|
|
if (sizes->data_ra > ra)
|
|
sizes->data_ra = FLOOR_PAGE(ra);
|
|
}
|
|
}
|
|
|
|
static void
|
|
htab_dma_binary(bfd *abfd,
|
|
sec_ptr sec,
|
|
PTR data)
|
|
{
|
|
htab_binary_sizes *sizes = (htab_binary_sizes*)data;
|
|
void *section_init;
|
|
unsigned_word section_vma;
|
|
unsigned_word section_size;
|
|
unsigned_word section_ra;
|
|
device *me = sizes->me;
|
|
|
|
/* skip the section if no memory to allocate */
|
|
if (! (bfd_get_section_flags(abfd, sec) & SEC_ALLOC))
|
|
return;
|
|
|
|
/* check/ignore any sections of size zero */
|
|
section_size = bfd_get_section_size (sec);
|
|
if (section_size == 0)
|
|
return;
|
|
|
|
/* if nothing to load, ignore this one */
|
|
if (! (bfd_get_section_flags(abfd, sec) & SEC_LOAD))
|
|
return;
|
|
|
|
/* find where it is to go */
|
|
section_vma = bfd_get_section_vma(abfd, sec);
|
|
section_ra = 0;
|
|
if ((bfd_get_section_flags (abfd, sec) & SEC_CODE)
|
|
|| (bfd_get_section_flags (abfd, sec) & SEC_READONLY))
|
|
section_ra = (section_vma - sizes->text_base + sizes->text_ra);
|
|
else if ((bfd_get_section_flags (abfd, sec) & SEC_DATA))
|
|
section_ra = (section_vma - sizes->data_base + sizes->data_ra);
|
|
else
|
|
return; /* just ignore it */
|
|
|
|
DTRACE(htab,
|
|
("load - name=%-7s vma=0x%.8lx size=%6ld ra=0x%.8lx flags=%3lx(%s%s%s%s%s )\n",
|
|
bfd_get_section_name(abfd, sec),
|
|
(long)section_vma,
|
|
(long)section_size,
|
|
(long)section_ra,
|
|
(long)bfd_get_section_flags(abfd, sec),
|
|
bfd_get_section_flags(abfd, sec) & SEC_LOAD ? " LOAD" : "",
|
|
bfd_get_section_flags(abfd, sec) & SEC_CODE ? " CODE" : "",
|
|
bfd_get_section_flags(abfd, sec) & SEC_DATA ? " DATA" : "",
|
|
bfd_get_section_flags(abfd, sec) & SEC_ALLOC ? " ALLOC" : "",
|
|
bfd_get_section_flags(abfd, sec) & SEC_READONLY ? " READONLY" : ""
|
|
));
|
|
|
|
/* dma in the sections data */
|
|
section_init = zalloc(section_size);
|
|
if (!bfd_get_section_contents(abfd,
|
|
sec,
|
|
section_init, 0,
|
|
section_size)) {
|
|
bfd_perror("devices/pte");
|
|
device_error(me, "no data loaded");
|
|
}
|
|
if (device_dma_write_buffer(device_parent(me),
|
|
section_init,
|
|
0 /*space*/,
|
|
section_ra,
|
|
section_size,
|
|
1 /*violate_read_only*/)
|
|
!= section_size)
|
|
device_error(me, "broken dma transfer");
|
|
free(section_init); /* only free if load */
|
|
}
|
|
|
|
/* create a memory map from a binaries virtual addresses to a copy of
|
|
the binary laid out linearly in memory */
|
|
|
|
static void
|
|
htab_map_binary(device *me,
|
|
device_instance *memory,
|
|
unsigned_word ra,
|
|
unsigned wimg,
|
|
unsigned pp,
|
|
const char *file_name,
|
|
unsigned32 htaborg,
|
|
unsigned32 htabmask)
|
|
{
|
|
htab_binary_sizes sizes;
|
|
bfd *image;
|
|
sizes.text_ra = -1;
|
|
sizes.data_ra = -1;
|
|
sizes.text_base = -1;
|
|
sizes.data_base = -1;
|
|
sizes.text_bound = 0;
|
|
sizes.data_bound = 0;
|
|
sizes.me = me;
|
|
|
|
/* open the file */
|
|
image = bfd_openr(file_name, NULL);
|
|
if (image == NULL) {
|
|
bfd_perror("devices/pte");
|
|
device_error(me, "the file %s not loaded", file_name);
|
|
}
|
|
|
|
/* check it is valid */
|
|
if (!bfd_check_format(image, bfd_object)) {
|
|
bfd_close(image);
|
|
device_error(me, "the file %s has an invalid binary format", file_name);
|
|
}
|
|
|
|
/* determine the size of each of the files regions */
|
|
bfd_map_over_sections (image, htab_sum_binary, (PTR) &sizes);
|
|
|
|
/* if needed, determine the real addresses of the sections */
|
|
if (ra != -1) {
|
|
sizes.text_ra = ra;
|
|
sizes.data_ra = ALIGN_PAGE(sizes.text_ra +
|
|
(sizes.text_bound - sizes.text_base));
|
|
}
|
|
|
|
DTRACE(htab, ("text map - base=0x%lx bound=0x%lx-1 ra=0x%lx\n",
|
|
(unsigned long)sizes.text_base,
|
|
(unsigned long)sizes.text_bound,
|
|
(unsigned long)sizes.text_ra));
|
|
DTRACE(htab, ("data map - base=0x%lx bound=0x%lx-1 ra=0x%lx\n",
|
|
(unsigned long)sizes.data_base,
|
|
(unsigned long)sizes.data_bound,
|
|
(unsigned long)sizes.data_ra));
|
|
|
|
/* check for and fix a botched image (text and data segments
|
|
overlap) */
|
|
if ((sizes.text_base <= sizes.data_base
|
|
&& sizes.text_bound >= sizes.data_bound)
|
|
|| (sizes.data_base <= sizes.text_base
|
|
&& sizes.data_bound >= sizes.text_bound)
|
|
|| (sizes.text_bound > sizes.data_base
|
|
&& sizes.text_bound <= sizes.data_bound)
|
|
|| (sizes.text_base >= sizes.data_base
|
|
&& sizes.text_base < sizes.data_bound)) {
|
|
DTRACE(htab, ("text and data segment overlaped - using just data segment\n"));
|
|
/* check va->ra linear */
|
|
if ((sizes.text_base - sizes.text_ra)
|
|
!= (sizes.data_base - sizes.data_ra))
|
|
device_error(me, "overlapping but missaligned text and data segments");
|
|
/* enlarge the data segment */
|
|
if (sizes.text_base < sizes.data_base)
|
|
sizes.data_base = sizes.text_base;
|
|
if (sizes.text_bound > sizes.data_bound)
|
|
sizes.data_bound = sizes.text_bound;
|
|
if (sizes.text_ra < sizes.data_ra)
|
|
sizes.data_ra = sizes.text_ra;
|
|
/* zap the text segment */
|
|
sizes.text_base = 0;
|
|
sizes.text_bound = 0;
|
|
sizes.text_ra = 0;
|
|
DTRACE(htab, ("common map - base=0x%lx bound=0x%lx-1 ra=0x%lx\n",
|
|
(unsigned long)sizes.data_base,
|
|
(unsigned long)sizes.data_bound,
|
|
(unsigned long)sizes.data_ra));
|
|
}
|
|
|
|
/* set up virtual memory maps for each of the regions */
|
|
if (sizes.text_bound - sizes.text_base > 0) {
|
|
htab_map_region(me, memory, sizes.text_ra, sizes.text_base,
|
|
sizes.text_bound - sizes.text_base,
|
|
wimg, pp,
|
|
htaborg, htabmask);
|
|
}
|
|
|
|
htab_map_region(me, memory, sizes.data_ra, sizes.data_base,
|
|
sizes.data_bound - sizes.data_base,
|
|
wimg, pp,
|
|
htaborg, htabmask);
|
|
|
|
/* dma the sections into physical memory */
|
|
bfd_map_over_sections (image, htab_dma_binary, (PTR) &sizes);
|
|
}
|
|
|
|
static void
|
|
htab_init_data_callback(device *me)
|
|
{
|
|
device_instance *memory = NULL;
|
|
if (WITH_TARGET_WORD_BITSIZE != 32)
|
|
device_error(me, "only 32bit targets currently suported");
|
|
|
|
/* find memory device */
|
|
if (device_find_property(me, "claim") != NULL)
|
|
memory = tree_find_ihandle_property(me, "/chosen/memory");
|
|
|
|
/* for the htab, just allocate space for it */
|
|
if (strcmp(device_name(me), "htab") == 0) {
|
|
unsigned_word address = device_find_integer_property(me, "real-address");
|
|
unsigned_word length = device_find_integer_property(me, "nr-bytes");
|
|
unsigned_word base = claim_memory(me, memory, address, length);
|
|
if (base == -1 || base != address)
|
|
device_error(me, "cannot allocate hash table");
|
|
}
|
|
|
|
/* for the pte, do all the real work */
|
|
if (strcmp(device_name(me), "pte") == 0) {
|
|
unsigned32 htaborg;
|
|
unsigned32 htabmask;
|
|
|
|
htab_decode_hash_table(me, &htaborg, &htabmask);
|
|
|
|
if (device_find_property(me, "file-name") != NULL) {
|
|
/* map in a binary */
|
|
unsigned pte_wimg = device_find_integer_property(me, "wimg");
|
|
unsigned pte_pp = device_find_integer_property(me, "pp");
|
|
const char *file_name = device_find_string_property(me, "file-name");
|
|
if (device_find_property(me, "real-address") != NULL) {
|
|
unsigned32 pte_ra = device_find_integer_property(me, "real-address");
|
|
DTRACE(htab, ("pte - ra=0x%lx, wimg=%ld, pp=%ld, file-name=%s\n",
|
|
(unsigned long)pte_ra,
|
|
(unsigned long)pte_wimg,
|
|
(long)pte_pp,
|
|
file_name));
|
|
htab_map_binary(me, memory, pte_ra, pte_wimg, pte_pp, file_name,
|
|
htaborg, htabmask);
|
|
}
|
|
else {
|
|
DTRACE(htab, ("pte - wimg=%ld, pp=%ld, file-name=%s\n",
|
|
(unsigned long)pte_wimg,
|
|
(long)pte_pp,
|
|
file_name));
|
|
htab_map_binary(me, memory, -1, pte_wimg, pte_pp, file_name,
|
|
htaborg, htabmask);
|
|
}
|
|
}
|
|
else {
|
|
/* handle a normal mapping definition */
|
|
unsigned64 pte_va = 0;
|
|
unsigned32 pte_ra = device_find_integer_property(me, "real-address");
|
|
unsigned pte_nr_bytes = device_find_integer_property(me, "nr-bytes");
|
|
unsigned pte_wimg = device_find_integer_property(me, "wimg");
|
|
unsigned pte_pp = device_find_integer_property(me, "pp");
|
|
signed_cell partial_va;
|
|
int i;
|
|
for (i = 0;
|
|
device_find_integer_array_property(me, "virtual-address", i, &partial_va);
|
|
i++) {
|
|
pte_va = (pte_va << WITH_TARGET_WORD_BITSIZE) | (unsigned_cell)partial_va;
|
|
}
|
|
DTRACE(htab, ("pte - ra=0x%lx, wimg=%ld, pp=%ld, va=0x%lx, nr_bytes=%ld\n",
|
|
(unsigned long)pte_ra,
|
|
(long)pte_wimg,
|
|
(long)pte_pp,
|
|
(unsigned long)pte_va,
|
|
(long)pte_nr_bytes));
|
|
htab_map_region(me, memory, pte_ra, pte_va, pte_nr_bytes, pte_wimg, pte_pp,
|
|
htaborg, htabmask);
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
static device_callbacks const htab_callbacks = {
|
|
{ NULL, htab_init_data_callback, },
|
|
{ NULL, }, /* address */
|
|
{ NULL, }, /* IO */
|
|
{ passthrough_device_dma_read_buffer,
|
|
passthrough_device_dma_write_buffer, },
|
|
{ NULL, }, /* interrupt */
|
|
{ generic_device_unit_decode,
|
|
generic_device_unit_encode, },
|
|
};
|
|
|
|
const device_descriptor hw_htab_device_descriptor[] = {
|
|
{ "htab", NULL, &htab_callbacks },
|
|
{ "pte", NULL, &htab_callbacks }, /* yep - uses htab's table */
|
|
{ NULL },
|
|
};
|
|
|
|
#endif /* _HW_HTAB_C_ */
|