Subversion Repositories HelenOS

Rev

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

Rev 2630 Rev 4126
Line 55... Line 55...
55
 * @return 0 on success or an error code from errno.h.
55
 * @return 0 on success or an error code from errno.h.
56
 */
56
 */
57
int ddi_iospace_enable_arch(task_t *task, uintptr_t ioaddr, size_t size)
57
int ddi_iospace_enable_arch(task_t *task, uintptr_t ioaddr, size_t size)
58
{
58
{
59
    count_t bits;
59
    count_t bits;
60
 
60
   
61
    bits = ioaddr + size;
61
    bits = ioaddr + size;
62
    if (bits > IO_PORTS)
62
    if (bits > IO_PORTS)
63
        return ENOENT;
63
        return ENOENT;
64
 
64
   
65
    if (task->arch.iomap.bits < bits) {
65
    if (task->arch.iomap.bits < bits) {
66
        bitmap_t oldiomap;
66
        bitmap_t oldiomap;
67
        uint8_t *newmap;
67
        uint8_t *newmap;
68
   
68
       
69
        /*
69
        /*
70
         * The I/O permission bitmap is too small and needs to be grown.
70
         * The I/O permission bitmap is too small and needs to be grown.
71
         */
71
         */
72
       
72
       
73
        newmap = (uint8_t *) malloc(BITS2BYTES(bits), FRAME_ATOMIC);
73
        newmap = (uint8_t *) malloc(BITS2BYTES(bits), FRAME_ATOMIC);
Line 75... Line 75...
75
            return ENOMEM;
75
            return ENOMEM;
76
       
76
       
77
        bitmap_initialize(&oldiomap, task->arch.iomap.map,
77
        bitmap_initialize(&oldiomap, task->arch.iomap.map,
78
            task->arch.iomap.bits);
78
            task->arch.iomap.bits);
79
        bitmap_initialize(&task->arch.iomap, newmap, bits);
79
        bitmap_initialize(&task->arch.iomap, newmap, bits);
80
 
80
       
81
        /*
81
        /*
82
         * Mark the new range inaccessible.
82
         * Mark the new range inaccessible.
83
         */
83
         */
84
        bitmap_set_range(&task->arch.iomap, oldiomap.bits,
84
        bitmap_set_range(&task->arch.iomap, oldiomap.bits,
85
            bits - oldiomap.bits);
85
            bits - oldiomap.bits);
86
 
86
       
87
        /*
87
        /*
88
         * In case there really existed smaller iomap,
88
         * In case there really existed smaller iomap,
89
         * copy its contents and deallocate it.
89
         * copy its contents and deallocate it.
90
         */    
90
         */
91
        if (oldiomap.bits) {
91
        if (oldiomap.bits) {
92
            bitmap_copy(&task->arch.iomap, &oldiomap,
92
            bitmap_copy(&task->arch.iomap, &oldiomap,
93
                oldiomap.bits);
93
                oldiomap.bits);
94
            free(oldiomap.map);
94
            free(oldiomap.map);
95
        }
95
        }
96
    }
96
    }
97
 
97
   
98
    /*
98
    /*
99
     * Enable the range and we are done.
99
     * Enable the range and we are done.
100
     */
100
     */
101
    bitmap_clear_range(&task->arch.iomap, (index_t) ioaddr, (count_t) size);
101
    bitmap_clear_range(&task->arch.iomap, (index_t) ioaddr, (count_t) size);
102
 
102
   
103
    /*
103
    /*
104
     * Increment I/O Permission bitmap generation counter.
104
     * Increment I/O Permission bitmap generation counter.
105
     */
105
     */
106
    task->arch.iomapver++;
106
    task->arch.iomapver++;
107
 
107
   
108
    return 0;
108
    return 0;
109
}
109
}
110
 
110
 
111
/** Install I/O Permission bitmap.
111
/** Install I/O Permission bitmap.
112
 *
112
 *
Line 120... Line 120...
120
    count_t bits;
120
    count_t bits;
121
    ptr_16_64_t cpugdtr;
121
    ptr_16_64_t cpugdtr;
122
    descriptor_t *gdt_p;
122
    descriptor_t *gdt_p;
123
    tss_descriptor_t *tss_desc;
123
    tss_descriptor_t *tss_desc;
124
    count_t ver;
124
    count_t ver;
125
 
125
   
126
    /* First, copy the I/O Permission Bitmap. */
126
    /* First, copy the I/O Permission Bitmap. */
127
    spinlock_lock(&TASK->lock);
127
    spinlock_lock(&TASK->lock);
128
    ver = TASK->arch.iomapver;
128
    ver = TASK->arch.iomapver;
129
    if ((bits = TASK->arch.iomap.bits)) {
129
    if ((bits = TASK->arch.iomap.bits)) {
130
        bitmap_t iomap;
130
        bitmap_t iomap;
Line 138... Line 138...
138
         * extra convenience byte in TSS_IOMAP_SIZE.
138
         * extra convenience byte in TSS_IOMAP_SIZE.
139
         */
139
         */
140
        bitmap_set_range(&iomap, ALIGN_UP(TASK->arch.iomap.bits, 8), 8);
140
        bitmap_set_range(&iomap, ALIGN_UP(TASK->arch.iomap.bits, 8), 8);
141
    }
141
    }
142
    spinlock_unlock(&TASK->lock);
142
    spinlock_unlock(&TASK->lock);
143
 
143
   
144
    /*
144
    /*
145
     * Second, adjust TSS segment limit.
145
     * Second, adjust TSS segment limit.
146
     * Take the extra ending byte will all bits set into account.
146
     * Take the extra ending byte will all bits set into account.
147
     */
147
     */
148
    gdtr_store(&cpugdtr);
148
    gdtr_store(&cpugdtr);
149
    gdt_p = (descriptor_t *) cpugdtr.base;
149
    gdt_p = (descriptor_t *) cpugdtr.base;
150
    gdt_tss_setlimit(&gdt_p[TSS_DES], TSS_BASIC_SIZE + BITS2BYTES(bits));
150
    gdt_tss_setlimit(&gdt_p[TSS_DES], TSS_BASIC_SIZE + BITS2BYTES(bits));
151
    gdtr_load(&cpugdtr);
151
    gdtr_load(&cpugdtr);
152
   
152
   
153
    /*
153
    /*
154
         * Before we load new TSS limit, the current TSS descriptor
154
     * Before we load new TSS limit, the current TSS descriptor
155
         * type must be changed to describe inactive TSS.
155
     * type must be changed to describe inactive TSS.
156
         */
156
     */
157
    tss_desc = (tss_descriptor_t *) &gdt_p[TSS_DES];
157
    tss_desc = (tss_descriptor_t *) &gdt_p[TSS_DES];
158
    tss_desc->type = AR_TSS;
158
    tss_desc->type = AR_TSS;
159
    tr_load(gdtselector(TSS_DES));
159
    tr_load(gdtselector(TSS_DES));
160
   
160
   
161
    /*
161
    /*
162
     * Update the generation count so that faults caused by
162
     * Update the generation count so that faults caused by