WebSVN – HelenOS – Diff – /branches/tracing/kernel/arch/amd64/src/ddi/ddi.c



 * @return 0 on success or an error code from errno.h.
 */
int ddi_iospace_enable_arch(task_t *task, uintptr_t ioaddr, size_t size)
{
    count_t bits;
   
    bits = ioaddr + size;
    if (bits > IO_PORTS)
        return ENOENT;
   
    if (task->arch.iomap.bits < bits) {
        bitmap_t oldiomap;
        uint8_t *newmap;
       
        /*
         * The I/O permission bitmap is too small and needs to be grown.
         */
       
        newmap = (uint8_t *) malloc(BITS2BYTES(bits), FRAME_ATOMIC);

            return ENOMEM;
       
        bitmap_initialize(&oldiomap, task->arch.iomap.map,
            task->arch.iomap.bits);
        bitmap_initialize(&task->arch.iomap, newmap, bits);
       
        /*
         * Mark the new range inaccessible.
         */
        bitmap_set_range(&task->arch.iomap, oldiomap.bits,
            bits - oldiomap.bits);
       
        /*
         * In case there really existed smaller iomap,
         * copy its contents and deallocate it.
         */
        if (oldiomap.bits) {
            bitmap_copy(&task->arch.iomap, &oldiomap,
                oldiomap.bits);
            free(oldiomap.map);
        }
    }
   
    /*
     * Enable the range and we are done.
     */
    bitmap_clear_range(&task->arch.iomap, (index_t) ioaddr, (count_t) size);
   
    /*
     * Increment I/O Permission bitmap generation counter.
     */
    task->arch.iomapver++;
   
    return 0;
}
 
/** Install I/O Permission bitmap.
 *

    count_t bits;
    ptr_16_64_t cpugdtr;
    descriptor_t *gdt_p;
    tss_descriptor_t *tss_desc;
    count_t ver;
   
    /* First, copy the I/O Permission Bitmap. */
    spinlock_lock(&TASK->lock);
    ver = TASK->arch.iomapver;
    if ((bits = TASK->arch.iomap.bits)) {
        bitmap_t iomap;

         * extra convenience byte in TSS_IOMAP_SIZE.
         */
        bitmap_set_range(&iomap, ALIGN_UP(TASK->arch.iomap.bits, 8), 8);
    }
    spinlock_unlock(&TASK->lock);
   
    /*
     * Second, adjust TSS segment limit.
     * Take the extra ending byte will all bits set into account.
     */
    gdtr_store(&cpugdtr);
    gdt_p = (descriptor_t *) cpugdtr.base;
    gdt_tss_setlimit(&gdt_p[TSS_DES], TSS_BASIC_SIZE + BITS2BYTES(bits));
    gdtr_load(&cpugdtr);
   
    /*
     * Before we load new TSS limit, the current TSS descriptor
     * type must be changed to describe inactive TSS.
     */
    tss_desc = (tss_descriptor_t *) &gdt_p[TSS_DES];
    tss_desc->type = AR_TSS;
    tr_load(gdtselector(TSS_DES));
   
    /*
     * Update the generation count so that faults caused by

Rev 2787	Rev 4377
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

Subversion Repositories HelenOS

(root)/branches/tracing/kernel/arch/amd64/src/ddi/ddi.c – Rev 2787 → 4377