WebSVN – HelenOS-historic – Blame – /kernel/trunk/arch/amd64/src/ddi/ddi.c

Rev	Author	Line No.	Line
1191	jermar	1	/*
		2	* Copyright (C) 2006 Jakub Jermar
		3	* All rights reserved.
		4	*
		5	* Redistribution and use in source and binary forms, with or without
		6	* modification, are permitted provided that the following conditions
		7	* are met:
		8	*
		9	* - Redistributions of source code must retain the above copyright
		10	* notice, this list of conditions and the following disclaimer.
		11	* - Redistributions in binary form must reproduce the above copyright
		12	* notice, this list of conditions and the following disclaimer in the
		13	* documentation and/or other materials provided with the distribution.
		14	* - The name of the author may not be used to endorse or promote products
		15	* derived from this software without specific prior written permission.
		16	*
		17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
		18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
		19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
		20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
		21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
		22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
		23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
		24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
		25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
		26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
		27	*/
		28
		29	#include <ddi/ddi.h>
1256	jermar	30	#include <arch/ddi/ddi.h>
1191	jermar	31	#include <proc/task.h>
		32	#include <arch/types.h>
		33	#include <typedefs.h>
1203	jermar	34	#include <adt/bitmap.h>
		35	#include <mm/slab.h>
		36	#include <arch/pm.h>
		37	#include <errno.h>
1212	palkovsky	38	#include <arch/cpu.h>
1256	jermar	39	#include <arch.h>
1263	jermar	40	#include <align.h>
1191	jermar	41
		42	/** Enable I/O space range for task.
		43	*
		44	* Interrupts are disabled and task is locked.
		45	*
		46	* @param task Task.
		47	* @param ioaddr Startign I/O space address.
		48	* @param size Size of the enabled I/O range.
		49	*
		50	* @return 0 on success or an error code from errno.h.
		51	*/
1227	jermar	52	int ddi_iospace_enable_arch(task_t *task, __address ioaddr, size_t size)
1191	jermar	53	{
1203	jermar	54	count_t bits;
		55
		56	bits = ioaddr + size;
		57	if (bits > IO_PORTS)
		58	return ENOENT;
		59
		60	if (task->arch.iomap.bits < bits) {
		61	bitmap_t oldiomap;
		62	__u8 *newmap;
		63
		64	/*
		65	* The I/O permission bitmap is too small and needs to be grown.
		66	*/
		67
		68	newmap = (__u8 *) malloc(BITS2BYTES(bits), FRAME_ATOMIC);
		69	if (!newmap)
		70	return ENOMEM;
		71
		72	bitmap_initialize(&oldiomap, task->arch.iomap.map, task->arch.iomap.bits);
		73	bitmap_initialize(&task->arch.iomap, newmap, bits);
		74
		75	/*
		76	* Mark the new range inaccessible.
		77	*/
		78	bitmap_set_range(&task->arch.iomap, oldiomap.bits, bits - oldiomap.bits);
		79
		80	/*
		81	* In case there really existed smaller iomap,
		82	* copy its contents and deallocate it.
		83	*/
		84	if (oldiomap.bits) {
1261	jermar	85	bitmap_copy(&task->arch.iomap, &oldiomap, oldiomap.bits);
1203	jermar	86	free(oldiomap.map);
		87	}
		88	}
		89
		90	/*
		91	* Enable the range and we are done.
		92	*/
		93	bitmap_clear_range(&task->arch.iomap, (index_t) ioaddr, (count_t) size);
		94
1256	jermar	95	/*
		96	* Increment I/O Permission bitmap generation counter.
		97	*/
		98	task->arch.iomapver++;
		99
1191	jermar	100	return 0;
		101	}
1212	palkovsky	102
		103	/** Enable/disable interrupts form syscall
		104	*
		105	* @param enable If non-zero, interrupts are enabled, otherwise disabled
1223	jermar	106	* @param flags RFLAGS register
1212	palkovsky	107	*/
		108	__native ddi_int_control_arch(__native enable, __native *flags)
		109	{
		110	if (enable)
		111	*flags \|= RFLAGS_IF;
		112	else
		113	*flags &= ~RFLAGS_IF;
		114	return 0;
		115	}
1256	jermar	116
		117	/** Install I/O Permission bitmap.
		118	*
		119	* Current task's I/O permission bitmap, if any, is installed
		120	* in the current CPU's TSS.
		121	*
		122	* Interrupts must be disabled prior this call.
		123	*/
		124	void io_perm_bitmap_install(void)
		125	{
		126	count_t bits;
		127	ptr_16_64_t cpugdtr;
		128	descriptor_t *gdt_p;
		129	tss_descriptor_t *tss_desc;
		130	count_t ver;
		131
		132	/* First, copy the I/O Permission Bitmap. */
		133	spinlock_lock(&TASK->lock);
		134	ver = TASK->arch.iomapver;
		135	if ((bits = TASK->arch.iomap.bits)) {
		136	bitmap_t iomap;
		137
		138	ASSERT(TASK->arch.iomap.map);
		139	bitmap_initialize(&iomap, CPU->arch.tss->iomap, TSS_IOMAP_SIZE * 8);
		140	bitmap_copy(&iomap, &TASK->arch.iomap, TASK->arch.iomap.bits);
		141	/*
		142	* It is safe to set the trailing eight bits because of the extra
		143	* convenience byte in TSS_IOMAP_SIZE.
		144	*/
1263	jermar	145	bitmap_set_range(&iomap, ALIGN_UP(TASK->arch.iomap.bits, 8), 8);
1256	jermar	146	}
		147	spinlock_unlock(&TASK->lock);
		148
1263	jermar	149	/*
		150	* Second, adjust TSS segment limit.
		151	* Take the extra ending byte will all bits set into account.
		152	*/
1256	jermar	153	gdtr_store(&cpugdtr);
		154	gdt_p = (descriptor_t *) cpugdtr.base;
1263	jermar	155	gdt_tss_setlimit(&gdt_p[TSS_DES], TSS_BASIC_SIZE + BITS2BYTES(bits));
1256	jermar	156	gdtr_load(&cpugdtr);
		157
		158	/*
		159	* Before we load new TSS limit, the current TSS descriptor
		160	* type must be changed to describe inactive TSS.
		161	*/
		162	tss_desc = (tss_descriptor_t *) &gdt_p[TSS_DES];
		163	tss_desc->type = AR_TSS;
		164	tr_load(gdtselector(TSS_DES));
		165
		166	/*
		167	* Update the generation count so that faults caused by
		168	* early accesses can be serviced.
		169	*/
		170	CPU->arch.iomapver_copy = ver;
		171	}

Subversion Repositories HelenOS-historic

(root)/kernel/trunk/arch/amd64/src/ddi/ddi.c @ 1780 – Rev 1263