Imported Upstream version 3.2.2
[debian/gnuradio] / gcell / ibm / sync / spu_source / cond_wait.h
1 /* --------------------------------------------------------------  */
2 /* (C)Copyright 2001,2007,                                         */
3 /* International Business Machines Corporation,                    */
4 /* Sony Computer Entertainment, Incorporated,                      */
5 /* Toshiba Corporation,                                            */
6 /*                                                                 */
7 /* All Rights Reserved.                                            */
8 /*                                                                 */
9 /* Redistribution and use in source and binary forms, with or      */
10 /* without modification, are permitted provided that the           */
11 /* following conditions are met:                                   */
12 /*                                                                 */
13 /* - Redistributions of source code must retain the above copyright*/
14 /*   notice, this list of conditions and the following disclaimer. */
15 /*                                                                 */
16 /* - Redistributions in binary form must reproduce the above       */
17 /*   copyright notice, this list of conditions and the following   */
18 /*   disclaimer in the documentation and/or other materials        */
19 /*   provided with the distribution.                               */
20 /*                                                                 */
21 /* - Neither the name of IBM Corporation nor the names of its      */
22 /*   contributors may be used to endorse or promote products       */
23 /*   derived from this software without specific prior written     */
24 /*   permission.                                                   */
25 /*                                                                 */
26 /* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND          */
27 /* CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES,     */
28 /* INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF        */
29 /* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE        */
30 /* DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR            */
31 /* CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,    */
32 /* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT    */
33 /* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;    */
34 /* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)        */
35 /* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN       */
36 /* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR    */
37 /* OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,  */
38 /* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.              */
39 /* --------------------------------------------------------------  */
40 /* PROLOG END TAG zYx                                              */
41 #ifndef _SPU_COND_WAIT_H_
42 #define _SPU_COND_WAIT_H_
43 #include <stdio.h>
44 #include "sync_irq.h"
45 #include "sync_utils.h"
46 #include "mutex_lock.h"
47 #include "mutex_unlock.h"
48 #include "cond.h"
49 #include <spu_mfcio.h>
50
51 static __inline void _cond_wait (cond_ea_t cond, mutex_ea_t  mutex)
52 {
53     char _tmp[256];                                     
54     char *tmp = (char *) ALIGN(_tmp, 128);              
55     volatile signed short *buf = (volatile signed short *) &tmp[0];       
56     unsigned int size = 128, tagid = 0;                          
57     int status;                                
58     unsigned int offset;                                         
59     addr64 ea64;  
60     signed short delta, cur_delta, signaled_cnt;
61
62     ea64.ull = ALIGN128_EA(cond);
63     offset = OFFSET128_EA_U16(cond);
64
65     /* increment the waiting halfword of the condition variable.
66      */
67     do {
68       MFC_DMA(buf, ea64, size, tagid, MFC_GETLLAR_CMD);
69       (void)spu_readch(MFC_RdAtomicStat);
70
71       buf[offset+1]++;
72       
73       MFC_DMA(buf, ea64, size, tagid, MFC_PUTLLC_CMD);
74       status = spu_readch(MFC_RdAtomicStat); 
75     } while (status);
76
77     _mutex_unlock(mutex);
78
79     /* keep track of the change in count needed to be signaled. This 
80      * is delta.
81      */
82     signaled_cnt = buf[offset];
83     delta = buf[offset+1] - signaled_cnt;
84     if (delta < 0) delta = -delta;
85
86     while (1) {
87       MFC_DMA(buf, ea64, size, tagid, MFC_GETLLAR_CMD);
88       (void)spu_readch(MFC_RdAtomicStat);
89
90       cur_delta = buf[offset] - signaled_cnt;
91       if (cur_delta < 0) cur_delta = -cur_delta;
92
93
94       if (cur_delta >= delta) {
95         /* the counts indicate that this thread has been signaled.
96          */
97         break;
98       } 
99     } 
100     _mutex_lock (mutex);
101 }
102
103 #endif /* _SPU_COND_WAIT_H_ */