WebSVN – HelenOS-historic – Diff – /kernel/trunk/generic/src/synch/futex.c


/*
 * Copyright (C) 2006 Jakub Jermar
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
/**
 * @file    futex.c
 * @brief   Kernel backend for futexes.
 */
 
#include <synch/futex.h>
#include <synch/rwlock.h>
#include <synch/spinlock.h>
#include <synch/synch.h>
#include <mm/frame.h>
#include <mm/page.h>
#include <mm/slab.h>
#include <proc/thread.h>
#include <proc/task.h>
#include <genarch/mm/page_pt.h>
#include <genarch/mm/page_ht.h>
#include <adt/hash_table.h>
#include <adt/list.h>
#include <arch.h>
#include <align.h>
#include <panic.h>
#include <errno.h>
#include <print.h>
 
#define FUTEX_HT_SIZE   1024    /* keep it a power of 2 */
 
static void futex_initialize(futex_t *futex);
 
static futex_t *futex_find(__address paddr);
static index_t futex_ht_hash(__native *key);
static bool futex_ht_compare(__native *key, count_t keys, link_t *item);
static void futex_ht_remove_callback(link_t *item);
 
/**
 * Read-write lock protecting global futex hash table.
 * It is also used to serialize access to all futex_t structures.
 * Must be acquired before the task futex B+tree lock.
 */
static rwlock_t futex_ht_lock;
 
/** Futex hash table. */
static hash_table_t futex_ht;
 
/** Futex hash table operations. */
static hash_table_operations_t futex_ht_ops = {
    .hash = futex_ht_hash,
    .compare = futex_ht_compare,
    .remove_callback = futex_ht_remove_callback
};
 
/** Initialize futex subsystem. */
void futex_init(void)
{
    rwlock_initialize(&futex_ht_lock);
    hash_table_create(&futex_ht, FUTEX_HT_SIZE, 1, &futex_ht_ops);
}
 
/** Initialize kernel futex structure.
 *
 * @param futex Kernel futex structure.
 */
void futex_initialize(futex_t *futex)
{
    waitq_initialize(&futex->wq);
    link_initialize(&futex->ht_link);
    futex->paddr = 0;
    futex->refcount = 1;
}
 
/** Sleep in futex wait queue.
 *
 * @param uaddr Userspace address of the futex counter.
 * @param usec If non-zero, number of microseconds this thread is willing to sleep.
 * @param flags Select mode of operation.
 *
 * @return One of ESYNCH_TIMEOUT, ESYNCH_OK_ATOMIC and ESYNCH_OK_BLOCKED. See synch.h.
 *     If there is no physical mapping for uaddr ENOENT is returned.
 */
__native sys_futex_sleep_timeout(__address uaddr, __u32 usec, int flags)
{
    futex_t *futex;
    __address paddr;
    pte_t *t;
    ipl_t ipl;
   
    ipl = interrupts_disable();
 
    /*
     * Find physical address of futex counter.
     */
    page_table_lock(AS, true);
    t = page_mapping_find(AS, ALIGN_DOWN(uaddr, PAGE_SIZE));
    if (!t || !PTE_VALID(t) || !PTE_PRESENT(t)) {
        page_table_unlock(AS, true);
        interrupts_restore(ipl);
        return (__native) ENOENT;
    }
    paddr = PTE_GET_FRAME(t) + (uaddr - ALIGN_DOWN(uaddr, PAGE_SIZE));
    page_table_unlock(AS, true);
   
    interrupts_restore(ipl);   
 
    futex = futex_find(paddr);
   
    return (__native) waitq_sleep_timeout(&futex->wq, usec, flags | SYNCH_FLAGS_INTERRUPTIBLE);
}
 
/** Wakeup one thread waiting in futex wait queue.
 *
 * @param uaddr Userspace address of the futex counter.
 *
 * @return ENOENT if there is no physical mapping for uaddr.
 */
__native sys_futex_wakeup(__address uaddr)
{
    futex_t *futex;
    __address paddr;
    pte_t *t;
    ipl_t ipl;
   
    ipl = interrupts_disable();
   
    /*
     * Find physical address of futex counter.
     */
    page_table_lock(AS, true);
    t = page_mapping_find(AS, ALIGN_DOWN(uaddr, PAGE_SIZE));
    if (!t || !PTE_VALID(t) || !PTE_PRESENT(t)) {
        page_table_unlock(AS, true);
        interrupts_restore(ipl);
        return (__native) ENOENT;
    }
    paddr = PTE_GET_FRAME(t) + (uaddr - ALIGN_DOWN(uaddr, PAGE_SIZE));
    page_table_unlock(AS, true);
   
    interrupts_restore(ipl);
 
    futex = futex_find(paddr);
       
    waitq_wakeup(&futex->wq, WAKEUP_FIRST);
   
    return 0;
}
 
/** Find kernel address of the futex structure corresponding to paddr.
 *
 * If the structure does not exist already, a new one is created.
 *
 * @param paddr Physical address of the userspace futex counter.
 *
 * @return Address of the kernel futex structure.
 */
futex_t *futex_find(__address paddr)
{
    link_t *item;
    futex_t *futex;
    btree_node_t *leaf;
   
    /*
     * Find the respective futex structure
     * or allocate new one if it does not exist already.
     */
    rwlock_read_lock(&futex_ht_lock);
    item = hash_table_find(&futex_ht, &paddr);
    if (item) {
        futex = hash_table_get_instance(item, futex_t, ht_link);
 
        /*
         * See if the current task knows this futex.
         */
        mutex_lock(&TASK->futexes_lock);
        if (!btree_search(&TASK->futexes, paddr, &leaf)) {
            /*
             * The futex is new to the current task.
             * However, we only have read access.
             * Gain write access and try again.
             */
            mutex_unlock(&TASK->futexes_lock);
            goto gain_write_access;
        }
        mutex_unlock(&TASK->futexes_lock);
 
        rwlock_read_unlock(&futex_ht_lock);
    } else {
gain_write_access:
        /*
         * Upgrade to writer is not currently supported,
         * therefore, it is necessary to release the read lock
         * and reacquire it as a writer.
         */
        rwlock_read_unlock(&futex_ht_lock);
 
        rwlock_write_lock(&futex_ht_lock);
        /*
         * Avoid possible race condition by searching
         * the hash table once again with write access.
         */
        item = hash_table_find(&futex_ht, &paddr);
        if (item) {
            futex = hash_table_get_instance(item, futex_t, ht_link);
           
            /*
             * See if this futex is known to the current task.
             */
            mutex_lock(&TASK->futexes_lock);
            if (!btree_search(&TASK->futexes, paddr, &leaf)) {
                /*
                 * The futex is new to the current task.
                 * Upgrade its reference count and put it to the
                 * current task's B+tree of known futexes.
                 */
                futex->refcount++;
                btree_insert(&TASK->futexes, paddr, futex, leaf);
            }
            mutex_unlock(&TASK->futexes_lock);
   
            rwlock_write_unlock(&futex_ht_lock);
        } else {
            futex = (futex_t *) malloc(sizeof(futex_t), 0);
            futex_initialize(futex);
            futex->paddr = paddr;
            hash_table_insert(&futex_ht, &paddr, &futex->ht_link);
           
            /*
             * This is the first task referencing the futex.
             * It can be directly inserted into its
             * B+tree of known futexes.
             */
            mutex_lock(&TASK->futexes_lock);
            btree_insert(&TASK->futexes, paddr, futex, NULL);
            mutex_unlock(&TASK->futexes_lock);
           
            rwlock_write_unlock(&futex_ht_lock);
        }
    }
   
    return futex;
}
 
/** Compute hash index into futex hash table.
 *
 * @param key Address where the key (i.e. physical address of futex counter) is stored.
 *
 * @return Index into futex hash table.
 */
index_t futex_ht_hash(__native *key)
{
    return *key & (FUTEX_HT_SIZE-1);
}
 
/** Compare futex hash table item with a key.
 *
 * @param key Address where the key (i.e. physical address of futex counter) is stored.
 *
 * @return True if the item matches the key. False otherwise.
 */
bool futex_ht_compare(__native *key, count_t keys, link_t *item)
{
    futex_t *futex;
 
    ASSERT(keys == 1);
 
    futex = hash_table_get_instance(item, futex_t, ht_link);
    return *key == futex->paddr;
}
 
/** Callback for removal items from futex hash table.
 *
 * @param item Item removed from the hash table.
 */
void futex_ht_remove_callback(link_t *item)
{
    futex_t *futex;
 
    futex = hash_table_get_instance(item, futex_t, ht_link);
    free(futex);
}
 
/** Remove references from futexes known to the current task. */
void futex_cleanup(void)
{
    link_t *cur;
   
    rwlock_write_lock(&futex_ht_lock);
    mutex_lock(&TASK->futexes_lock);
 
    for (cur = TASK->futexes.leaf_head.next; cur != &TASK->futexes.leaf_head; cur = cur->next) {
        btree_node_t *node;
        int i;
       
        node = list_get_instance(cur, btree_node_t, leaf_link);
        for (i = 0; i < node->keys; i++) {
            futex_t *ftx;
            __address paddr = node->key[i];
           
            ftx = (futex_t *) node->value[i];
            if (--ftx->refcount == 0)
                hash_table_remove(&futex_ht, &paddr, 1);
        }
    }
   
    mutex_unlock(&TASK->futexes_lock);
    rwlock_write_unlock(&futex_ht_lock);
}
 

Rev 1583	Rev 1586
1	/*	1	/*
2	* Copyright (C) 2006 Jakub Jermar	2	* Copyright (C) 2006 Jakub Jermar
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	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	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.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	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	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	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	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	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	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.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	/**	29	/**
30	* @file futex.c	30	* @file futex.c
31	* @brief Kernel backend for futexes.	31	* @brief Kernel backend for futexes.
32	*/	32	*/
33		33
34	#include <synch/futex.h>	34	#include <synch/futex.h>
35	#include <synch/rwlock.h>	35	#include <synch/rwlock.h>
36	#include <synch/spinlock.h>	36	#include <synch/spinlock.h>
37	#include <synch/synch.h>	37	#include <synch/synch.h>
38	#include <mm/frame.h>	38	#include <mm/frame.h>
39	#include <mm/page.h>	39	#include <mm/page.h>
40	#include <mm/slab.h>	40	#include <mm/slab.h>
41	#include <proc/thread.h>	41	#include <proc/thread.h>
42	#include <proc/task.h>	42	#include <proc/task.h>
43	#include <genarch/mm/page_pt.h>	43	#include <genarch/mm/page_pt.h>
44	#include <genarch/mm/page_ht.h>	44	#include <genarch/mm/page_ht.h>
45	#include <adt/hash_table.h>	45	#include <adt/hash_table.h>
46	#include <adt/list.h>	46	#include <adt/list.h>
47	#include <arch.h>	47	#include <arch.h>
48	#include <align.h>	48	#include <align.h>
49	#include <panic.h>	49	#include <panic.h>
50	#include <errno.h>	50	#include <errno.h>
51	#include <print.h>	51	#include <print.h>
52		52
53	#define FUTEX_HT_SIZE 1024 /* keep it a power of 2 */	53	#define FUTEX_HT_SIZE 1024 /* keep it a power of 2 */
54		54
55	static void futex_initialize(futex_t *futex);	55	static void futex_initialize(futex_t *futex);
56		56
57	static futex_t *futex_find(__address paddr);	57	static futex_t *futex_find(__address paddr);
58	static index_t futex_ht_hash(__native *key);	58	static index_t futex_ht_hash(__native *key);
59	static bool futex_ht_compare(__native key, count_t keys, link_t item);	59	static bool futex_ht_compare(__native key, count_t keys, link_t item);
60	static void futex_ht_remove_callback(link_t *item);	60	static void futex_ht_remove_callback(link_t *item);
61		61
62	/**	62	/**
63	* Read-write lock protecting global futex hash table.	63	* Read-write lock protecting global futex hash table.
64	* It is also used to serialize access to all futex_t structures.	64	* It is also used to serialize access to all futex_t structures.
65	* Must be acquired before the task futex B+tree lock.	65	* Must be acquired before the task futex B+tree lock.
66	*/	66	*/
67	static rwlock_t futex_ht_lock;	67	static rwlock_t futex_ht_lock;
68		68
69	/** Futex hash table. */	69	/** Futex hash table. */
70	static hash_table_t futex_ht;	70	static hash_table_t futex_ht;
71		71
72	/** Futex hash table operations. */	72	/** Futex hash table operations. */
73	static hash_table_operations_t futex_ht_ops = {	73	static hash_table_operations_t futex_ht_ops = {
74	.hash = futex_ht_hash,	74	.hash = futex_ht_hash,
75	.compare = futex_ht_compare,	75	.compare = futex_ht_compare,
76	.remove_callback = futex_ht_remove_callback	76	.remove_callback = futex_ht_remove_callback
77	};	77	};
78		78
79	/** Initialize futex subsystem. */	79	/** Initialize futex subsystem. */
80	void futex_init(void)	80	void futex_init(void)
81	{	81	{
82	rwlock_initialize(&futex_ht_lock);	82	rwlock_initialize(&futex_ht_lock);
83	hash_table_create(&futex_ht, FUTEX_HT_SIZE, 1, &futex_ht_ops);	83	hash_table_create(&futex_ht, FUTEX_HT_SIZE, 1, &futex_ht_ops);
84	}	84	}
85		85
86	/** Initialize kernel futex structure.	86	/** Initialize kernel futex structure.
87	*	87	*
88	* @param futex Kernel futex structure.	88	* @param futex Kernel futex structure.
89	*/	89	*/
90	void futex_initialize(futex_t *futex)	90	void futex_initialize(futex_t *futex)
91	{	91	{
92	waitq_initialize(&futex->wq);	92	waitq_initialize(&futex->wq);
93	link_initialize(&futex->ht_link);	93	link_initialize(&futex->ht_link);
94	futex->paddr = 0;	94	futex->paddr = 0;
95	futex->refcount = 1;	95	futex->refcount = 1;
96	}	96	}
97		97
98	/** Sleep in futex wait queue.	98	/** Sleep in futex wait queue.
99	*	99	*
100	* @param uaddr Userspace address of the futex counter.	100	* @param uaddr Userspace address of the futex counter.
101	* @param usec If non-zero, number of microseconds this thread is willing to sleep.	101	* @param usec If non-zero, number of microseconds this thread is willing to sleep.
102	* @param flags Select mode of operation.	102	* @param flags Select mode of operation.
103	*	103	*
104	* @return One of ESYNCH_TIMEOUT, ESYNCH_OK_ATOMIC and ESYNCH_OK_BLOCKED. See synch.h.	104	* @return One of ESYNCH_TIMEOUT, ESYNCH_OK_ATOMIC and ESYNCH_OK_BLOCKED. See synch.h.
105	* If there is no physical mapping for uaddr ENOENT is returned.	105	* If there is no physical mapping for uaddr ENOENT is returned.
106	*/	106	*/
107	__native sys_futex_sleep_timeout(__address uaddr, __u32 usec, int flags)	107	__native sys_futex_sleep_timeout(__address uaddr, __u32 usec, int flags)
108	{	108	{
109	futex_t *futex;	109	futex_t *futex;
110	__address paddr;	110	__address paddr;
111	pte_t *t;	111	pte_t *t;
112	ipl_t ipl;	112	ipl_t ipl;
113		113
114	ipl = interrupts_disable();	114	ipl = interrupts_disable();
115		115
116	/*	116	/*
117	* Find physical address of futex counter.	117	* Find physical address of futex counter.
118	*/	118	*/
119	page_table_lock(AS, true);	119	page_table_lock(AS, true);
120	t = page_mapping_find(AS, ALIGN_DOWN(uaddr, PAGE_SIZE));	120	t = page_mapping_find(AS, ALIGN_DOWN(uaddr, PAGE_SIZE));
121	if (!t \|\| !PTE_VALID(t) \|\| !PTE_PRESENT(t)) {	121	if (!t \|\| !PTE_VALID(t) \|\| !PTE_PRESENT(t)) {
122	page_table_unlock(AS, true);	122	page_table_unlock(AS, true);
123	interrupts_restore(ipl);	123	interrupts_restore(ipl);
124	return (__native) ENOENT;	124	return (__native) ENOENT;
125	}	125	}
126	paddr = PTE_GET_FRAME(t) + (uaddr - ALIGN_DOWN(uaddr, PAGE_SIZE));	126	paddr = PTE_GET_FRAME(t) + (uaddr - ALIGN_DOWN(uaddr, PAGE_SIZE));
127	page_table_unlock(AS, true);	127	page_table_unlock(AS, true);
128		128
129	interrupts_restore(ipl);	129	interrupts_restore(ipl);
130		130
131	futex = futex_find(paddr);	131	futex = futex_find(paddr);
132		132
133	return (__native) waitq_sleep_timeout(&futex->wq, usec, flags \| SYNCH_FLAGS_INTERRUPTIBLE);	133	return (__native) waitq_sleep_timeout(&futex->wq, usec, flags \| SYNCH_FLAGS_INTERRUPTIBLE);
134	}	134	}
135		135
136	/** Wakeup one thread waiting in futex wait queue.	136	/** Wakeup one thread waiting in futex wait queue.
137	*	137	*
138	* @param uaddr Userspace address of the futex counter.	138	* @param uaddr Userspace address of the futex counter.
139	*	139	*
140	* @return ENOENT if there is no physical mapping for uaddr.	140	* @return ENOENT if there is no physical mapping for uaddr.
141	*/	141	*/
142	__native sys_futex_wakeup(__address uaddr)	142	__native sys_futex_wakeup(__address uaddr)
143	{	143	{
144	futex_t *futex;	144	futex_t *futex;
145	__address paddr;	145	__address paddr;
146	pte_t *t;	146	pte_t *t;
147	ipl_t ipl;	147	ipl_t ipl;
148		148
149	ipl = interrupts_disable();	149	ipl = interrupts_disable();
150		150
151	/*	151	/*
152	* Find physical address of futex counter.	152	* Find physical address of futex counter.
153	*/	153	*/
154	page_table_lock(AS, true);	154	page_table_lock(AS, true);
155	t = page_mapping_find(AS, ALIGN_DOWN(uaddr, PAGE_SIZE));	155	t = page_mapping_find(AS, ALIGN_DOWN(uaddr, PAGE_SIZE));
156	if (!t \|\| !PTE_VALID(t) \|\| !PTE_PRESENT(t)) {	156	if (!t \|\| !PTE_VALID(t) \|\| !PTE_PRESENT(t)) {
157	page_table_unlock(AS, true);	157	page_table_unlock(AS, true);
158	interrupts_restore(ipl);	158	interrupts_restore(ipl);
159	return (__native) ENOENT;	159	return (__native) ENOENT;
160	}	160	}
161	paddr = PTE_GET_FRAME(t) + (uaddr - ALIGN_DOWN(uaddr, PAGE_SIZE));	161	paddr = PTE_GET_FRAME(t) + (uaddr - ALIGN_DOWN(uaddr, PAGE_SIZE));
162	page_table_unlock(AS, true);	162	page_table_unlock(AS, true);
163		163
164	interrupts_restore(ipl);	164	interrupts_restore(ipl);
165		165
166	futex = futex_find(paddr);	166	futex = futex_find(paddr);
167		167
168	waitq_wakeup(&futex->wq, WAKEUP_FIRST);	168	waitq_wakeup(&futex->wq, WAKEUP_FIRST);
169		169
170	return 0;	170	return 0;
171	}	171	}
172		172
173	/** Find kernel address of the futex structure corresponding to paddr.	173	/** Find kernel address of the futex structure corresponding to paddr.
174	*	174	*
175	* If the structure does not exist already, a new one is created.	175	* If the structure does not exist already, a new one is created.
176	*	176	*
177	* @param paddr Physical address of the userspace futex counter.	177	* @param paddr Physical address of the userspace futex counter.
178	*	178	*
179	* @return Address of the kernel futex structure.	179	* @return Address of the kernel futex structure.
180	*/	180	*/
181	futex_t *futex_find(__address paddr)	181	futex_t *futex_find(__address paddr)
182	{	182	{
183	link_t *item;	183	link_t *item;
184	futex_t *futex;	184	futex_t *futex;
185	btree_node_t *leaf;	185	btree_node_t *leaf;
186		186
187	/*	187	/*
188	* Find the respective futex structure	188	* Find the respective futex structure
189	* or allocate new one if it does not exist already.	189	* or allocate new one if it does not exist already.
190	*/	190	*/
191	rwlock_read_lock(&futex_ht_lock);	191	rwlock_read_lock(&futex_ht_lock);
192	item = hash_table_find(&futex_ht, &paddr);	192	item = hash_table_find(&futex_ht, &paddr);
193	if (item) {	193	if (item) {
194	futex = hash_table_get_instance(item, futex_t, ht_link);	194	futex = hash_table_get_instance(item, futex_t, ht_link);
195		195
196	/*	196	/*
197	* See if the current task knows this futex.	197	* See if the current task knows this futex.
198	*/	198	*/
199	mutex_lock(&TASK->futexes_lock);	199	mutex_lock(&TASK->futexes_lock);
200	if (!btree_search(&TASK->futexes, paddr, &leaf)) {	200	if (!btree_search(&TASK->futexes, paddr, &leaf)) {
201	/*	201	/*
202	* The futex is new to the current task.	202	* The futex is new to the current task.
203	* However, we only have read access.	203	* However, we only have read access.
204	* Gain write access and try again.	204	* Gain write access and try again.
205	*/	205	*/
206	mutex_unlock(&TASK->futexes_lock);	206	mutex_unlock(&TASK->futexes_lock);
207	goto gain_write_access;	207	goto gain_write_access;
208	}	208	}
209	mutex_unlock(&TASK->futexes_lock);	209	mutex_unlock(&TASK->futexes_lock);
210		210
211	rwlock_read_unlock(&futex_ht_lock);	211	rwlock_read_unlock(&futex_ht_lock);
212	} else {	212	} else {
213	gain_write_access:	213	gain_write_access:
214	/*	214	/*
215	* Upgrade to writer is not currently supported,	215	* Upgrade to writer is not currently supported,
216	* therefore, it is necessary to release the read lock	216	* therefore, it is necessary to release the read lock
217	* and reacquire it as a writer.	217	* and reacquire it as a writer.
218	*/	218	*/
219	rwlock_read_unlock(&futex_ht_lock);	219	rwlock_read_unlock(&futex_ht_lock);
220		220
221	rwlock_write_lock(&futex_ht_lock);	221	rwlock_write_lock(&futex_ht_lock);
222	/*	222	/*
223	* Avoid possible race condition by searching	223	* Avoid possible race condition by searching
224	* the hash table once again with write access.	224	* the hash table once again with write access.
225	*/	225	*/
226	item = hash_table_find(&futex_ht, &paddr);	226	item = hash_table_find(&futex_ht, &paddr);
227	if (item) {	227	if (item) {
228	futex = hash_table_get_instance(item, futex_t, ht_link);	228	futex = hash_table_get_instance(item, futex_t, ht_link);
229		229
230	/*	230	/*
231	* See if this futex is known to the current task.	231	* See if this futex is known to the current task.
232	*/	232	*/
233	mutex_lock(&TASK->futexes_lock);	233	mutex_lock(&TASK->futexes_lock);
234	if (!btree_search(&TASK->futexes, paddr, &leaf)) {	234	if (!btree_search(&TASK->futexes, paddr, &leaf)) {
235	/*	235	/*
236	* The futex is new to the current task.	236	* The futex is new to the current task.
237	* Upgrade its reference count and put it to the	237	* Upgrade its reference count and put it to the
238	* current task's B+tree of known futexes.	238	* current task's B+tree of known futexes.
239	*/	239	*/
240	futex->refcount++;	240	futex->refcount++;
241	btree_insert(&TASK->futexes, paddr, futex, leaf);	241	btree_insert(&TASK->futexes, paddr, futex, leaf);
242	}	242	}
243	mutex_unlock(&TASK->futexes_lock);	243	mutex_unlock(&TASK->futexes_lock);
244		244
245	rwlock_write_unlock(&futex_ht_lock);	245	rwlock_write_unlock(&futex_ht_lock);
246	} else {	246	} else {
247	futex = (futex_t *) malloc(sizeof(futex_t), 0);	247	futex = (futex_t *) malloc(sizeof(futex_t), 0);
248	futex_initialize(futex);	248	futex_initialize(futex);
249	futex->paddr = paddr;	249	futex->paddr = paddr;
250	hash_table_insert(&futex_ht, &paddr, &futex->ht_link);	250	hash_table_insert(&futex_ht, &paddr, &futex->ht_link);
251		251
252	/*	252	/*
253	* This is the first task referencing the futex.	253	* This is the first task referencing the futex.
254	* It can be directly inserted into its	254	* It can be directly inserted into its
255	* B+tree of known futexes.	255	* B+tree of known futexes.
256	*/	256	*/
257	mutex_lock(&TASK->futexes_lock);	257	mutex_lock(&TASK->futexes_lock);
258	btree_insert(&TASK->futexes, paddr, futex, NULL);	258	btree_insert(&TASK->futexes, paddr, futex, NULL);
259	mutex_unlock(&TASK->futexes_lock);	259	mutex_unlock(&TASK->futexes_lock);
260		260
261	rwlock_write_unlock(&futex_ht_lock);	261	rwlock_write_unlock(&futex_ht_lock);
262	}	262	}
263	}	263	}
264		264
265	return futex;	265	return futex;
266	}	266	}
267		267
268	/** Compute hash index into futex hash table.	268	/** Compute hash index into futex hash table.
269	*	269	*
270	* @param key Address where the key (i.e. physical address of futex counter) is stored.	270	* @param key Address where the key (i.e. physical address of futex counter) is stored.
271	*	271	*
272	* @return Index into futex hash table.	272	* @return Index into futex hash table.
273	*/	273	*/
274	index_t futex_ht_hash(__native *key)	274	index_t futex_ht_hash(__native *key)
275	{	275	{
276	return *key & (FUTEX_HT_SIZE-1);	276	return *key & (FUTEX_HT_SIZE-1);
277	}	277	}
278		278
279	/** Compare futex hash table item with a key.	279	/** Compare futex hash table item with a key.
280	*	280	*
281	* @param key Address where the key (i.e. physical address of futex counter) is stored.	281	* @param key Address where the key (i.e. physical address of futex counter) is stored.
282	*	282	*
283	* @return True if the item matches the key. False otherwise.	283	* @return True if the item matches the key. False otherwise.
284	*/	284	*/
285	bool futex_ht_compare(__native key, count_t keys, link_t item)	285	bool futex_ht_compare(__native key, count_t keys, link_t item)
286	{	286	{
287	futex_t *futex;	287	futex_t *futex;
288		288
289	ASSERT(keys == 1);	289	ASSERT(keys == 1);
290		290
291	futex = hash_table_get_instance(item, futex_t, ht_link);	291	futex = hash_table_get_instance(item, futex_t, ht_link);
292	return *key == futex->paddr;	292	return *key == futex->paddr;
293	}	293	}
294		294
295	/** Callback for removal items from futex hash table.	295	/** Callback for removal items from futex hash table.
296	*	296	*
297	* @param item Item removed from the hash table.	297	* @param item Item removed from the hash table.
298	*/	298	*/
299	void futex_ht_remove_callback(link_t *item)	299	void futex_ht_remove_callback(link_t *item)
300	{	300	{
301	futex_t *futex;	301	futex_t *futex;
302		302
303	futex = hash_table_get_instance(item, futex_t, ht_link);	303	futex = hash_table_get_instance(item, futex_t, ht_link);
304	free(futex);	304	free(futex);
305	}	305	}
306		306
307	/** Remove references from futexes known to the current task. */	307	/** Remove references from futexes known to the current task. */
308	void futex_cleanup(void)	308	void futex_cleanup(void)
309	{	309	{
-		310	link_t *cur;
-		311
-		312	rwlock_write_lock(&futex_ht_lock);
-		313	mutex_lock(&TASK->futexes_lock);
-		314
-		315	for (cur = TASK->futexes.leaf_head.next; cur != &TASK->futexes.leaf_head; cur = cur->next) {
-		316	btree_node_t *node;
-		317	int i;
-		318
-		319	node = list_get_instance(cur, btree_node_t, leaf_link);
-		320	for (i = 0; i < node->keys; i++) {
-		321	futex_t *ftx;
-		322	__address paddr = node->key[i];
-		323
-		324	ftx = (futex_t *) node->value[i];
-		325	if (--ftx->refcount == 0)
-		326	hash_table_remove(&futex_ht, &paddr, 1);
-		327	}
-		328	}
-		329
-		330	mutex_unlock(&TASK->futexes_lock);
-		331	rwlock_write_unlock(&futex_ht_lock);
310	}	332	}
311		333

Subversion Repositories HelenOS-historic

(root)/kernel/trunk/generic/src/synch/futex.c – Rev 1583 → 1586