Subversion Repositories HelenOS

Rev

Rev 935 | Rev 945 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 935 Rev 944
Line 42... Line 42...
42
#include <arch/asm.h>
42
#include <arch/asm.h>
43
#include <typedefs.h>
43
#include <typedefs.h>
44
#include <panic.h>
44
#include <panic.h>
45
#include <arch.h>
45
#include <arch.h>
46
 
46
 
-
 
47
 
-
 
48
 
47
/** Invalidate all TLB entries. */
49
/** Invalidate all TLB entries. */
48
void tlb_invalidate_all(void)
50
void tlb_invalidate_all(void)
49
{
51
{
50
        __address adr;
52
        __address adr;
51
        __u32 count1,count2,stride1,stride2;
53
        __u32 count1,count2,stride1,stride2;
Line 89... Line 91...
89
{
91
{
90
    /* TODO */
92
    /* TODO */
91
    tlb_invalidate_all();
93
    tlb_invalidate_all();
92
}
94
}
93
 
95
 
-
 
96
extern void d(void);
-
 
97
void d(void)
-
 
98
{
-
 
99
}
-
 
100
 
94
 
101
 
95
void tlb_invalidate_pages(asid_t asid, __address page, count_t cnt)
102
void tlb_invalidate_pages(asid_t asid, __address va, count_t cnt)
96
{
103
{
97
 
104
 
98
 
105
 
-
 
106
    region_register rr;
-
 
107
    bool restore_rr = false;
-
 
108
    int b=0;
-
 
109
    int c=cnt;
-
 
110
    int i;
-
 
111
 
-
 
112
    rr.word = rr_read(VA2VRN(va));
-
 
113
    if ((restore_rr = (rr.map.rid != ASID2RID(asid, VA2VRN(va))))) {
-
 
114
        /*
-
 
115
         * The selected region register does not contain required RID.
-
 
116
         * Save the old content of the register and replace the RID.
-
 
117
         */
-
 
118
        region_register rr0;
-
 
119
 
-
 
120
        rr0 = rr;
-
 
121
        rr0.map.rid = ASID2RID(asid, VA2VRN(va));
-
 
122
        rr_write(VA2VRN(va), rr0.word);
-
 
123
        srlz_d();
-
 
124
        srlz_i();
-
 
125
    }
-
 
126
   
-
 
127
    while(c>>=1)    b++;
-
 
128
    b>>=1;
-
 
129
    __u64 ps;
-
 
130
   
-
 
131
    switch(b)
-
 
132
    {
-
 
133
        case 0: /*cnt 1-3*/
-
 
134
        {
-
 
135
            ps=PAGE_WIDTH;
-
 
136
            break;
-
 
137
        }
-
 
138
        case 1: /*cnt 4-15*/
-
 
139
        {
-
 
140
            cnt=(cnt/4)+1;
-
 
141
            ps=PAGE_WIDTH+2;
-
 
142
            va&=~((1<<ps)-1);
-
 
143
            break;
-
 
144
        }
-
 
145
        case 2: /*cnt 16-63*/
-
 
146
        {
-
 
147
            cnt=(cnt/16)+1;
-
 
148
            ps=PAGE_WIDTH+4;
-
 
149
            va&=~((1<<ps)-1);
-
 
150
            break;
-
 
151
        }
-
 
152
        case 3: /*cnt 64-255*/
-
 
153
        {
-
 
154
            cnt=(cnt/64)+1;
-
 
155
            ps=PAGE_WIDTH+6;
-
 
156
            va&=~((1<<ps)-1);
-
 
157
            break;
-
 
158
        }
-
 
159
        case 4: /*cnt 256-1023*/
-
 
160
        {
-
 
161
            cnt=(cnt/256)+1;
-
 
162
            ps=PAGE_WIDTH+8;
-
 
163
            va&=~((1<<ps)-1);
-
 
164
            break;
-
 
165
        }
-
 
166
        case 5: /*cnt 1024-4095*/
-
 
167
        {
-
 
168
            cnt=(cnt/1024)+1;
-
 
169
            ps=PAGE_WIDTH+10;
-
 
170
            va&=~((1<<ps)-1);
-
 
171
            break;
-
 
172
        }
-
 
173
        case 6: /*cnt 4096-16383*/
-
 
174
        {
-
 
175
            cnt=(cnt/4096)+1;
-
 
176
            ps=PAGE_WIDTH+12;
-
 
177
            va&=~((1<<ps)-1);
-
 
178
            break;
-
 
179
        }
-
 
180
        case 7: /*cnt 16384-65535*/
-
 
181
        case 8: /*cnt 65536-(256K-1)*/
-
 
182
        {
-
 
183
            cnt=(cnt/16384)+1;
-
 
184
            ps=PAGE_WIDTH+14;
-
 
185
            va&=~((1<<ps)-1);
-
 
186
            break;
-
 
187
        }
-
 
188
        default:
-
 
189
        {
-
 
190
            cnt=(cnt/(16384*16))+1;
-
 
191
            ps=PAGE_WIDTH+18;
-
 
192
            va&=~((1<<ps)-1);
-
 
193
            break;
-
 
194
        }
-
 
195
           
-
 
196
    }
-
 
197
    d();
-
 
198
    for(i=0;i<cnt;i++)  {
-
 
199
    __asm__ volatile
-
 
200
    (
-
 
201
        "ptc.l %0,%1;;"
-
 
202
        :
-
 
203
        : "r"(va), "r"(ps<<2)
-
 
204
    );
-
 
205
    va+=(1<<ps);
-
 
206
    }
-
 
207
    srlz_d();
-
 
208
    srlz_i();
-
 
209
   
-
 
210
   
-
 
211
    if (restore_rr) {
-
 
212
        rr_write(VA2VRN(va), rr.word);
-
 
213
        srlz_d();
-
 
214
        srlz_i();
-
 
215
    }
-
 
216
 
-
 
217
 
99
}
218
}
100
 
219
 
101
 
220
 
102
/** Insert data into data translation cache.
221
/** Insert data into data translation cache.
103
 *
222
 *