1 | /* |
---|
2 | * Copyright (c) 2006 Kolja Waschk rtemsdev/ixo.de |
---|
3 | * |
---|
4 | * The license and distribution terms for this file may be |
---|
5 | * found in the file LICENSE in this distribution or at |
---|
6 | * http://www.rtems.org/license/LICENSE. |
---|
7 | */ |
---|
8 | |
---|
9 | #include <stdio.h> |
---|
10 | #include <stdlib.h> |
---|
11 | #include <string.h> |
---|
12 | |
---|
13 | #include "ptf.h" |
---|
14 | #include "devices.h" |
---|
15 | #include "memory.h" |
---|
16 | |
---|
17 | memory_desc *find_memory(device_desc *devices) |
---|
18 | { |
---|
19 | struct ptf *p; |
---|
20 | struct ptf_item pi; |
---|
21 | memory_desc *tmd, *memory; |
---|
22 | |
---|
23 | /********************************************************/ |
---|
24 | /* Check which of the devices are memory, sort by size */ |
---|
25 | |
---|
26 | if(devices) |
---|
27 | { |
---|
28 | struct ptf *p, *s; |
---|
29 | struct ptf_item pi; |
---|
30 | device_desc *dd; |
---|
31 | |
---|
32 | memory = NULL; |
---|
33 | |
---|
34 | for(dd = devices; dd; dd=dd->next) |
---|
35 | { |
---|
36 | p = ptf_find(dd->ptf->sub, &pi, item, "Is_Memory_Device", "1"); |
---|
37 | if(p != NULL && pi.level>0) |
---|
38 | { |
---|
39 | s = pi.item[pi.level-1]; |
---|
40 | p = ptf_find(s, &pi, item, "Base_Address", 0); |
---|
41 | }; |
---|
42 | |
---|
43 | if(p != NULL) |
---|
44 | { |
---|
45 | tmd = (memory_desc*)malloc(sizeof(memory_desc)); |
---|
46 | |
---|
47 | if(tmd != NULL) |
---|
48 | { |
---|
49 | tmd->base = strtoul(p->value, 0, 0); |
---|
50 | |
---|
51 | p = ptf_find(s, &pi, item, "Address_Span", 0); |
---|
52 | if(p != 0) |
---|
53 | { |
---|
54 | tmd->size = strtoul(p->value, 0, 0); |
---|
55 | } |
---|
56 | else |
---|
57 | { |
---|
58 | tmd->size = 0; |
---|
59 | p = ptf_find(s, &pi, item, "Address_Width", 0); |
---|
60 | if(p) tmd->size = 1 << strtoul(p->value, 0, 0); |
---|
61 | p = ptf_find(s, &pi, item, "Data_Width", 0); |
---|
62 | if(p) tmd->size *= (strtoul(p->value, 0, 0) >> 3); |
---|
63 | }; |
---|
64 | |
---|
65 | if(tmd->size == 0) |
---|
66 | { |
---|
67 | free(tmd); |
---|
68 | } |
---|
69 | else |
---|
70 | { |
---|
71 | tmd->dev = dd; |
---|
72 | |
---|
73 | if(memory == NULL) |
---|
74 | { |
---|
75 | tmd->next = NULL; |
---|
76 | memory = tmd; |
---|
77 | } |
---|
78 | else |
---|
79 | { |
---|
80 | if(tmd->size > memory->size) |
---|
81 | { |
---|
82 | tmd->next = memory; |
---|
83 | memory = tmd; |
---|
84 | } |
---|
85 | else |
---|
86 | { |
---|
87 | memory_desc *uplink = memory; |
---|
88 | while(uplink->next != NULL && uplink->next->size > tmd->size) uplink=uplink->next; |
---|
89 | tmd->next = uplink->next; |
---|
90 | uplink->next = tmd; |
---|
91 | }; |
---|
92 | }; |
---|
93 | }; |
---|
94 | }; |
---|
95 | }; |
---|
96 | }; |
---|
97 | }; |
---|
98 | |
---|
99 | return memory; |
---|
100 | } |
---|
101 | |
---|
102 | |
---|