forked from sin365/AxibugEmuOnline
487 lines
22 KiB
C
487 lines
22 KiB
C
|
<EFBFBD><EFBFBD>/ *
|
|||
|
|
* T h i s f i l e i s p a r t o f t h e A d v a n c e p r o j e c t .
|
|||
|
|
*
|
|||
|
|
* C o p y r i g h t ( C ) 2 0 0 3 A n d r e a M a z z o l e n i
|
|||
|
|
*
|
|||
|
|
* T h i s p r o g r a m i s f r e e s o f t w a r e ; y o u c a n r e d i s t r i b u t e i t a n d / o r m o d i f y
|
|||
|
|
* i t u n d e r t h e t e r m s o f t h e G N U G e n e r a l P u b l i c L i c e n s e a s p u b l i s h e d b y
|
|||
|
|
* t h e F r e e S o f t w a r e F o u n d a t i o n ; e i t h e r v e r s i o n 2 o f t h e L i c e n s e , o r
|
|||
|
|
* ( a t y o u r o p t i o n ) a n y l a t e r v e r s i o n .
|
|||
|
|
*
|
|||
|
|
* T h i s p r o g r a m i s d i s t r i b u t e d i n t h e h o p e t h a t i t w i l l b e u s e f u l ,
|
|||
|
|
* b u t W I T H O U T A N Y W A R R A N T Y ; w i t h o u t e v e n t h e i m p l i e d w a r r a n t y o f
|
|||
|
|
* M E R C H A N T A B I L I T Y o r F I T N E S S F O R A P A R T I C U L A R P U R P O S E . S e e t h e
|
|||
|
|
* G N U G e n e r a l P u b l i c L i c e n s e f o r m o r e d e t a i l s .
|
|||
|
|
*
|
|||
|
|
* Y o u s h o u l d h a v e r e c e i v e d a c o p y o f t h e G N U G e n e r a l P u b l i c L i c e n s e
|
|||
|
|
* a l o n g w i t h t h i s p r o g r a m ; i f n o t , w r i t e t o t h e F r e e S o f t w a r e
|
|||
|
|
* F o u n d a t i o n , I n c . , 6 7 5 M a s s A v e , C a m b r i d g e , M A 0 2 1 3 9 , U S A .
|
|||
|
|
*
|
|||
|
|
* I n a d d i t i o n , a s a s p e c i a l e x c e p t i o n , A n d r e a M a z z o l e n i
|
|||
|
|
* g i v e s p e r m i s s i o n t o l i n k t h e c o d e o f t h i s p r o g r a m w i t h
|
|||
|
|
* t h e M A M E l i b r a r y ( o r w i t h m o d i f i e d v e r s i o n s o f M A M E t h a t u s e t h e
|
|||
|
|
* s a m e l i c e n s e a s M A M E ) , a n d d i s t r i b u t e l i n k e d c o m b i n a t i o n s i n c l u d i n g
|
|||
|
|
* t h e t w o . Y o u m u s t o b e y t h e G N U G e n e r a l P u b l i c L i c e n s e i n a l l
|
|||
|
|
* r e s p e c t s f o r a l l o f t h e c o d e u s e d o t h e r t h a n M A M E . I f y o u m o d i f y
|
|||
|
|
* t h i s f i l e , y o u m a y e x t e n d t h i s e x c e p t i o n t o y o u r v e r s i o n o f t h e
|
|||
|
|
* f i l e , b u t y o u a r e n o t o b l i g a t e d t o d o s o . I f y o u d o n o t w i s h t o
|
|||
|
|
* d o s o , d e l e t e t h i s e x c e p t i o n s t a t e m e n t f r o m y o u r v e r s i o n .
|
|||
|
|
* /
|
|||
|
|
|
|||
|
|
# i n c l u d e " i n t e r p . h "
|
|||
|
|
|
|||
|
|
/ * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * /
|
|||
|
|
/ * H Q 2 x C i m p l e m e n t a t i o n * /
|
|||
|
|
|
|||
|
|
/ *
|
|||
|
|
* T h i s e f f e c t i s a r e w r i t t e n i m p l e m e n t a t i o n o f t h e h q 2 x e f f e c t m a d e b y M a x i m S t e p i n
|
|||
|
|
* /
|
|||
|
|
|
|||
|
|
s t a t i c v o i d h q 2 x _ 1 6 _ d e f ( e u I 1 6 * d s t 0 , e u I 1 6 * d s t 1 , c o n s t e u I 1 6 * s r c 0 , c o n s t e u I 1 6 * s r c 1 , c o n s t e u I 1 6 * s r c 2 , u n s i g n e d c o u n t )
|
|||
|
|
{
|
|||
|
|
u n s i g n e d i ;
|
|||
|
|
|
|||
|
|
f o r ( i = 0 ; i < c o u n t ; + + i ) {
|
|||
|
|
u n s i g n e d c h a r m a s k ;
|
|||
|
|
|
|||
|
|
e u I 1 6 c [ 9 ] ;
|
|||
|
|
|
|||
|
|
c [ 1 ] = s r c 0 [ 0 ] ;
|
|||
|
|
c [ 4 ] = s r c 1 [ 0 ] ;
|
|||
|
|
c [ 7 ] = s r c 2 [ 0 ] ;
|
|||
|
|
|
|||
|
|
i f ( i > 0 ) {
|
|||
|
|
c [ 0 ] = s r c 0 [ - 1 ] ;
|
|||
|
|
c [ 3 ] = s r c 1 [ - 1 ] ;
|
|||
|
|
c [ 6 ] = s r c 2 [ - 1 ] ;
|
|||
|
|
} e l s e {
|
|||
|
|
c [ 0 ] = c [ 1 ] ;
|
|||
|
|
c [ 3 ] = c [ 4 ] ;
|
|||
|
|
c [ 6 ] = c [ 7 ] ;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
i f ( i < c o u n t - 1 ) {
|
|||
|
|
c [ 2 ] = s r c 0 [ 1 ] ;
|
|||
|
|
c [ 5 ] = s r c 1 [ 1 ] ;
|
|||
|
|
c [ 8 ] = s r c 2 [ 1 ] ;
|
|||
|
|
} e l s e {
|
|||
|
|
c [ 2 ] = c [ 1 ] ;
|
|||
|
|
c [ 5 ] = c [ 4 ] ;
|
|||
|
|
c [ 8 ] = c [ 7 ] ;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
m a s k = 0 ;
|
|||
|
|
|
|||
|
|
i f ( i n t e r p _ 1 6 _ d i f f ( c [ 0 ] , c [ 4 ] ) )
|
|||
|
|
m a s k | = 1 < < 0 ;
|
|||
|
|
i f ( i n t e r p _ 1 6 _ d i f f ( c [ 1 ] , c [ 4 ] ) )
|
|||
|
|
m a s k | = 1 < < 1 ;
|
|||
|
|
i f ( i n t e r p _ 1 6 _ d i f f ( c [ 2 ] , c [ 4 ] ) )
|
|||
|
|
m a s k | = 1 < < 2 ;
|
|||
|
|
i f ( i n t e r p _ 1 6 _ d i f f ( c [ 3 ] , c [ 4 ] ) )
|
|||
|
|
m a s k | = 1 < < 3 ;
|
|||
|
|
i f ( i n t e r p _ 1 6 _ d i f f ( c [ 5 ] , c [ 4 ] ) )
|
|||
|
|
m a s k | = 1 < < 4 ;
|
|||
|
|
i f ( i n t e r p _ 1 6 _ d i f f ( c [ 6 ] , c [ 4 ] ) )
|
|||
|
|
m a s k | = 1 < < 5 ;
|
|||
|
|
i f ( i n t e r p _ 1 6 _ d i f f ( c [ 7 ] , c [ 4 ] ) )
|
|||
|
|
m a s k | = 1 < < 6 ;
|
|||
|
|
i f ( i n t e r p _ 1 6 _ d i f f ( c [ 8 ] , c [ 4 ] ) )
|
|||
|
|
m a s k | = 1 < < 7 ;
|
|||
|
|
|
|||
|
|
# d e f i n e P 0 d s t 0 [ 0 ]
|
|||
|
|
# d e f i n e P 1 d s t 0 [ 1 ]
|
|||
|
|
# d e f i n e P 2 d s t 1 [ 0 ]
|
|||
|
|
# d e f i n e P 3 d s t 1 [ 1 ]
|
|||
|
|
# d e f i n e M U R i n t e r p _ 1 6 _ d i f f ( c [ 1 ] , c [ 5 ] )
|
|||
|
|
# d e f i n e M D R i n t e r p _ 1 6 _ d i f f ( c [ 5 ] , c [ 7 ] )
|
|||
|
|
# d e f i n e M D L i n t e r p _ 1 6 _ d i f f ( c [ 7 ] , c [ 3 ] )
|
|||
|
|
# d e f i n e M U L i n t e r p _ 1 6 _ d i f f ( c [ 3 ] , c [ 1 ] )
|
|||
|
|
# d e f i n e I C ( p 0 ) c [ p 0 ]
|
|||
|
|
# d e f i n e I 1 1 ( p 0 , p 1 ) i n t e r p _ 1 6 _ 1 1 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 2 1 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 1 6 _ 2 1 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 3 1 ( p 0 , p 1 ) i n t e r p _ 1 6 _ 3 1 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 3 3 2 ( p 0 , p 1 , p 2 ) i n t e r p _ 1 6 _ 3 3 2 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 4 3 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 1 6 _ 4 3 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 5 2 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 1 6 _ 5 2 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 5 3 ( p 0 , p 1 ) i n t e r p _ 1 6 _ 5 3 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 6 1 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 1 6 _ 6 1 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 7 1 ( p 0 , p 1 ) i n t e r p _ 1 6 _ 7 1 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 7 7 2 ( p 0 , p 1 , p 2 ) i n t e r p _ 1 6 _ 7 7 2 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 9 7 ( p 0 , p 1 ) i n t e r p _ 1 6 _ 9 7 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 1 4 1 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 1 6 _ 1 4 1 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 1 5 1 ( p 0 , p 1 ) i n t e r p _ 1 6 _ 1 5 1 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
|
|||
|
|
s w i t c h ( m a s k ) {
|
|||
|
|
# i n c l u d e " h q 2 x . h "
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
# u n d e f P 0
|
|||
|
|
# u n d e f P 1
|
|||
|
|
# u n d e f P 2
|
|||
|
|
# u n d e f P 3
|
|||
|
|
# u n d e f M U R
|
|||
|
|
# u n d e f M D R
|
|||
|
|
# u n d e f M D L
|
|||
|
|
# u n d e f M U L
|
|||
|
|
# u n d e f I C
|
|||
|
|
# u n d e f I 1 1
|
|||
|
|
# u n d e f I 2 1 1
|
|||
|
|
# u n d e f I 3 1
|
|||
|
|
# u n d e f I 3 3 2
|
|||
|
|
# u n d e f I 4 3 1
|
|||
|
|
# u n d e f I 5 2 1
|
|||
|
|
# u n d e f I 5 3
|
|||
|
|
# u n d e f I 6 1 1
|
|||
|
|
# u n d e f I 7 1
|
|||
|
|
# u n d e f I 7 7 2
|
|||
|
|
# u n d e f I 9 7
|
|||
|
|
# u n d e f I 1 4 1 1
|
|||
|
|
# u n d e f I 1 5 1
|
|||
|
|
|
|||
|
|
s r c 0 + = 1 ;
|
|||
|
|
s r c 1 + = 1 ;
|
|||
|
|
s r c 2 + = 1 ;
|
|||
|
|
d s t 0 + = 2 ;
|
|||
|
|
d s t 1 + = 2 ;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
s t a t i c v o i d h q 2 x _ 3 2 _ d e f ( e u I 3 2 * d s t 0 , e u I 3 2 * d s t 1 , c o n s t e u I 3 2 * s r c 0 , c o n s t e u I 3 2 * s r c 1 , c o n s t e u I 3 2 * s r c 2 , u n s i g n e d c o u n t )
|
|||
|
|
{
|
|||
|
|
u n s i g n e d i ;
|
|||
|
|
|
|||
|
|
f o r ( i = 0 ; i < c o u n t ; + + i ) {
|
|||
|
|
u n s i g n e d c h a r m a s k ;
|
|||
|
|
|
|||
|
|
e u I 3 2 c [ 9 ] ;
|
|||
|
|
|
|||
|
|
c [ 1 ] = s r c 0 [ 0 ] ;
|
|||
|
|
c [ 4 ] = s r c 1 [ 0 ] ;
|
|||
|
|
c [ 7 ] = s r c 2 [ 0 ] ;
|
|||
|
|
|
|||
|
|
i f ( i > 0 ) {
|
|||
|
|
c [ 0 ] = s r c 0 [ - 1 ] ;
|
|||
|
|
c [ 3 ] = s r c 1 [ - 1 ] ;
|
|||
|
|
c [ 6 ] = s r c 2 [ - 1 ] ;
|
|||
|
|
} e l s e {
|
|||
|
|
c [ 0 ] = c [ 1 ] ;
|
|||
|
|
c [ 3 ] = c [ 4 ] ;
|
|||
|
|
c [ 6 ] = c [ 7 ] ;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
i f ( i < c o u n t - 1 ) {
|
|||
|
|
c [ 2 ] = s r c 0 [ 1 ] ;
|
|||
|
|
c [ 5 ] = s r c 1 [ 1 ] ;
|
|||
|
|
c [ 8 ] = s r c 2 [ 1 ] ;
|
|||
|
|
} e l s e {
|
|||
|
|
c [ 2 ] = c [ 1 ] ;
|
|||
|
|
c [ 5 ] = c [ 4 ] ;
|
|||
|
|
c [ 8 ] = c [ 7 ] ;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
m a s k = 0 ;
|
|||
|
|
|
|||
|
|
i f ( i n t e r p _ 3 2 _ d i f f ( c [ 0 ] , c [ 4 ] ) )
|
|||
|
|
m a s k | = 1 < < 0 ;
|
|||
|
|
i f ( i n t e r p _ 3 2 _ d i f f ( c [ 1 ] , c [ 4 ] ) )
|
|||
|
|
m a s k | = 1 < < 1 ;
|
|||
|
|
i f ( i n t e r p _ 3 2 _ d i f f ( c [ 2 ] , c [ 4 ] ) )
|
|||
|
|
m a s k | = 1 < < 2 ;
|
|||
|
|
i f ( i n t e r p _ 3 2 _ d i f f ( c [ 3 ] , c [ 4 ] ) )
|
|||
|
|
m a s k | = 1 < < 3 ;
|
|||
|
|
i f ( i n t e r p _ 3 2 _ d i f f ( c [ 5 ] , c [ 4 ] ) )
|
|||
|
|
m a s k | = 1 < < 4 ;
|
|||
|
|
i f ( i n t e r p _ 3 2 _ d i f f ( c [ 6 ] , c [ 4 ] ) )
|
|||
|
|
m a s k | = 1 < < 5 ;
|
|||
|
|
i f ( i n t e r p _ 3 2 _ d i f f ( c [ 7 ] , c [ 4 ] ) )
|
|||
|
|
m a s k | = 1 < < 6 ;
|
|||
|
|
i f ( i n t e r p _ 3 2 _ d i f f ( c [ 8 ] , c [ 4 ] ) )
|
|||
|
|
m a s k | = 1 < < 7 ;
|
|||
|
|
|
|||
|
|
# d e f i n e P 0 d s t 0 [ 0 ]
|
|||
|
|
# d e f i n e P 1 d s t 0 [ 1 ]
|
|||
|
|
# d e f i n e P 2 d s t 1 [ 0 ]
|
|||
|
|
# d e f i n e P 3 d s t 1 [ 1 ]
|
|||
|
|
# d e f i n e M U R i n t e r p _ 3 2 _ d i f f ( c [ 1 ] , c [ 5 ] )
|
|||
|
|
# d e f i n e M D R i n t e r p _ 3 2 _ d i f f ( c [ 5 ] , c [ 7 ] )
|
|||
|
|
# d e f i n e M D L i n t e r p _ 3 2 _ d i f f ( c [ 7 ] , c [ 3 ] )
|
|||
|
|
# d e f i n e M U L i n t e r p _ 3 2 _ d i f f ( c [ 3 ] , c [ 1 ] )
|
|||
|
|
# d e f i n e I C ( p 0 ) c [ p 0 ]
|
|||
|
|
# d e f i n e I 1 1 ( p 0 , p 1 ) i n t e r p _ 3 2 _ 1 1 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 2 1 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 3 2 _ 2 1 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 3 1 ( p 0 , p 1 ) i n t e r p _ 3 2 _ 3 1 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 3 3 2 ( p 0 , p 1 , p 2 ) i n t e r p _ 3 2 _ 3 3 2 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 4 3 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 3 2 _ 4 3 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 5 2 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 3 2 _ 5 2 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 5 3 ( p 0 , p 1 ) i n t e r p _ 3 2 _ 5 3 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 6 1 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 3 2 _ 6 1 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 7 1 ( p 0 , p 1 ) i n t e r p _ 3 2 _ 7 1 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 7 7 2 ( p 0 , p 1 , p 2 ) i n t e r p _ 3 2 _ 7 7 2 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 9 7 ( p 0 , p 1 ) i n t e r p _ 3 2 _ 9 7 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 1 4 1 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 3 2 _ 1 4 1 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 1 5 1 ( p 0 , p 1 ) i n t e r p _ 3 2 _ 1 5 1 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
|
|||
|
|
s w i t c h ( m a s k ) {
|
|||
|
|
# i n c l u d e " h q 2 x . h "
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
# u n d e f P 0
|
|||
|
|
# u n d e f P 1
|
|||
|
|
# u n d e f P 2
|
|||
|
|
# u n d e f P 3
|
|||
|
|
# u n d e f M U R
|
|||
|
|
# u n d e f M D R
|
|||
|
|
# u n d e f M D L
|
|||
|
|
# u n d e f M U L
|
|||
|
|
# u n d e f I C
|
|||
|
|
# u n d e f I 1 1
|
|||
|
|
# u n d e f I 2 1 1
|
|||
|
|
# u n d e f I 3 1
|
|||
|
|
# u n d e f I 3 3 2
|
|||
|
|
# u n d e f I 4 3 1
|
|||
|
|
# u n d e f I 5 2 1
|
|||
|
|
# u n d e f I 5 3
|
|||
|
|
# u n d e f I 6 1 1
|
|||
|
|
# u n d e f I 7 1
|
|||
|
|
# u n d e f I 7 7 2
|
|||
|
|
# u n d e f I 9 7
|
|||
|
|
# u n d e f I 1 4 1 1
|
|||
|
|
# u n d e f I 1 5 1
|
|||
|
|
|
|||
|
|
s r c 0 + = 1 ;
|
|||
|
|
s r c 1 + = 1 ;
|
|||
|
|
s r c 2 + = 1 ;
|
|||
|
|
d s t 0 + = 2 ;
|
|||
|
|
d s t 1 + = 2 ;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
/ * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * /
|
|||
|
|
/ * L Q 2 x C i m p l e m e n t a t i o n * /
|
|||
|
|
|
|||
|
|
/ *
|
|||
|
|
* T h i s e f f e c t i s d e r i v e d f r o m t h e h q 2 x e f f e c t m a d e b y M a x i m S t e p i n
|
|||
|
|
* /
|
|||
|
|
|
|||
|
|
s t a t i c v o i d l q 2 x _ 1 6 _ d e f ( e u I 1 6 * d s t 0 , e u I 1 6 * d s t 1 , c o n s t e u I 1 6 * s r c 0 , c o n s t e u I 1 6 * s r c 1 , c o n s t e u I 1 6 * s r c 2 , u n s i g n e d c o u n t )
|
|||
|
|
{
|
|||
|
|
u n s i g n e d i ;
|
|||
|
|
|
|||
|
|
f o r ( i = 0 ; i < c o u n t ; + + i ) {
|
|||
|
|
u n s i g n e d c h a r m a s k ;
|
|||
|
|
|
|||
|
|
e u I 1 6 c [ 9 ] ;
|
|||
|
|
|
|||
|
|
c [ 1 ] = s r c 0 [ 0 ] ;
|
|||
|
|
c [ 4 ] = s r c 1 [ 0 ] ;
|
|||
|
|
c [ 7 ] = s r c 2 [ 0 ] ;
|
|||
|
|
|
|||
|
|
i f ( i > 0 ) {
|
|||
|
|
c [ 0 ] = s r c 0 [ - 1 ] ;
|
|||
|
|
c [ 3 ] = s r c 1 [ - 1 ] ;
|
|||
|
|
c [ 6 ] = s r c 2 [ - 1 ] ;
|
|||
|
|
} e l s e {
|
|||
|
|
c [ 0 ] = c [ 1 ] ;
|
|||
|
|
c [ 3 ] = c [ 4 ] ;
|
|||
|
|
c [ 6 ] = c [ 7 ] ;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
i f ( i < c o u n t - 1 ) {
|
|||
|
|
c [ 2 ] = s r c 0 [ 1 ] ;
|
|||
|
|
c [ 5 ] = s r c 1 [ 1 ] ;
|
|||
|
|
c [ 8 ] = s r c 2 [ 1 ] ;
|
|||
|
|
} e l s e {
|
|||
|
|
c [ 2 ] = c [ 1 ] ;
|
|||
|
|
c [ 5 ] = c [ 4 ] ;
|
|||
|
|
c [ 8 ] = c [ 7 ] ;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
m a s k = 0 ;
|
|||
|
|
|
|||
|
|
i f ( c [ 0 ] ! = c [ 4 ] )
|
|||
|
|
m a s k | = 1 < < 0 ;
|
|||
|
|
i f ( c [ 1 ] ! = c [ 4 ] )
|
|||
|
|
m a s k | = 1 < < 1 ;
|
|||
|
|
i f ( c [ 2 ] ! = c [ 4 ] )
|
|||
|
|
m a s k | = 1 < < 2 ;
|
|||
|
|
i f ( c [ 3 ] ! = c [ 4 ] )
|
|||
|
|
m a s k | = 1 < < 3 ;
|
|||
|
|
i f ( c [ 5 ] ! = c [ 4 ] )
|
|||
|
|
m a s k | = 1 < < 4 ;
|
|||
|
|
i f ( c [ 6 ] ! = c [ 4 ] )
|
|||
|
|
m a s k | = 1 < < 5 ;
|
|||
|
|
i f ( c [ 7 ] ! = c [ 4 ] )
|
|||
|
|
m a s k | = 1 < < 6 ;
|
|||
|
|
i f ( c [ 8 ] ! = c [ 4 ] )
|
|||
|
|
m a s k | = 1 < < 7 ;
|
|||
|
|
|
|||
|
|
# d e f i n e P 0 d s t 0 [ 0 ]
|
|||
|
|
# d e f i n e P 1 d s t 0 [ 1 ]
|
|||
|
|
# d e f i n e P 2 d s t 1 [ 0 ]
|
|||
|
|
# d e f i n e P 3 d s t 1 [ 1 ]
|
|||
|
|
# d e f i n e M U R ( c [ 1 ] ! = c [ 5 ] )
|
|||
|
|
# d e f i n e M D R ( c [ 5 ] ! = c [ 7 ] )
|
|||
|
|
# d e f i n e M D L ( c [ 7 ] ! = c [ 3 ] )
|
|||
|
|
# d e f i n e M U L ( c [ 3 ] ! = c [ 1 ] )
|
|||
|
|
# d e f i n e I C ( p 0 ) c [ p 0 ]
|
|||
|
|
# d e f i n e I 1 1 ( p 0 , p 1 ) i n t e r p _ 1 6 _ 1 1 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 2 1 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 1 6 _ 2 1 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 3 1 ( p 0 , p 1 ) i n t e r p _ 1 6 _ 3 1 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 3 3 2 ( p 0 , p 1 , p 2 ) i n t e r p _ 1 6 _ 3 3 2 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 4 3 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 1 6 _ 4 3 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 5 2 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 1 6 _ 5 2 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 5 3 ( p 0 , p 1 ) i n t e r p _ 1 6 _ 5 3 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 6 1 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 1 6 _ 6 1 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 7 1 ( p 0 , p 1 ) i n t e r p _ 1 6 _ 7 1 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 7 7 2 ( p 0 , p 1 , p 2 ) i n t e r p _ 1 6 _ 7 7 2 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 9 7 ( p 0 , p 1 ) i n t e r p _ 1 6 _ 9 7 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 1 4 1 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 1 6 _ 1 4 1 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 1 5 1 ( p 0 , p 1 ) i n t e r p _ 1 6 _ 1 5 1 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
|
|||
|
|
s w i t c h ( m a s k ) {
|
|||
|
|
# i n c l u d e " l q 2 x . h "
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
# u n d e f P 0
|
|||
|
|
# u n d e f P 1
|
|||
|
|
# u n d e f P 2
|
|||
|
|
# u n d e f P 3
|
|||
|
|
# u n d e f M U R
|
|||
|
|
# u n d e f M D R
|
|||
|
|
# u n d e f M D L
|
|||
|
|
# u n d e f M U L
|
|||
|
|
# u n d e f I C
|
|||
|
|
# u n d e f I 1 1
|
|||
|
|
# u n d e f I 2 1 1
|
|||
|
|
# u n d e f I 3 1
|
|||
|
|
# u n d e f I 3 3 2
|
|||
|
|
# u n d e f I 4 3 1
|
|||
|
|
# u n d e f I 5 2 1
|
|||
|
|
# u n d e f I 5 3
|
|||
|
|
# u n d e f I 6 1 1
|
|||
|
|
# u n d e f I 7 1
|
|||
|
|
# u n d e f I 7 7 2
|
|||
|
|
# u n d e f I 9 7
|
|||
|
|
# u n d e f I 1 4 1 1
|
|||
|
|
# u n d e f I 1 5 1
|
|||
|
|
|
|||
|
|
s r c 0 + = 1 ;
|
|||
|
|
s r c 1 + = 1 ;
|
|||
|
|
s r c 2 + = 1 ;
|
|||
|
|
d s t 0 + = 2 ;
|
|||
|
|
d s t 1 + = 2 ;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
s t a t i c v o i d l q 2 x _ 3 2 _ d e f ( e u I 3 2 * d s t 0 , e u I 3 2 * d s t 1 , c o n s t e u I 3 2 * s r c 0 , c o n s t e u I 3 2 * s r c 1 , c o n s t e u I 3 2 * s r c 2 , u n s i g n e d c o u n t )
|
|||
|
|
{
|
|||
|
|
u n s i g n e d i ;
|
|||
|
|
|
|||
|
|
f o r ( i = 0 ; i < c o u n t ; + + i ) {
|
|||
|
|
u n s i g n e d c h a r m a s k ;
|
|||
|
|
|
|||
|
|
e u I 3 2 c [ 9 ] ;
|
|||
|
|
|
|||
|
|
c [ 1 ] = s r c 0 [ 0 ] ;
|
|||
|
|
c [ 4 ] = s r c 1 [ 0 ] ;
|
|||
|
|
c [ 7 ] = s r c 2 [ 0 ] ;
|
|||
|
|
|
|||
|
|
i f ( i > 0 ) {
|
|||
|
|
c [ 0 ] = s r c 0 [ - 1 ] ;
|
|||
|
|
c [ 3 ] = s r c 1 [ - 1 ] ;
|
|||
|
|
c [ 6 ] = s r c 2 [ - 1 ] ;
|
|||
|
|
} e l s e {
|
|||
|
|
c [ 0 ] = c [ 1 ] ;
|
|||
|
|
c [ 3 ] = c [ 4 ] ;
|
|||
|
|
c [ 6 ] = c [ 7 ] ;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
i f ( i < c o u n t - 1 ) {
|
|||
|
|
c [ 2 ] = s r c 0 [ 1 ] ;
|
|||
|
|
c [ 5 ] = s r c 1 [ 1 ] ;
|
|||
|
|
c [ 8 ] = s r c 2 [ 1 ] ;
|
|||
|
|
} e l s e {
|
|||
|
|
c [ 2 ] = c [ 1 ] ;
|
|||
|
|
c [ 5 ] = c [ 4 ] ;
|
|||
|
|
c [ 8 ] = c [ 7 ] ;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
m a s k = 0 ;
|
|||
|
|
|
|||
|
|
i f ( c [ 0 ] ! = c [ 4 ] )
|
|||
|
|
m a s k | = 1 < < 0 ;
|
|||
|
|
i f ( c [ 1 ] ! = c [ 4 ] )
|
|||
|
|
m a s k | = 1 < < 1 ;
|
|||
|
|
i f ( c [ 2 ] ! = c [ 4 ] )
|
|||
|
|
m a s k | = 1 < < 2 ;
|
|||
|
|
i f ( c [ 3 ] ! = c [ 4 ] )
|
|||
|
|
m a s k | = 1 < < 3 ;
|
|||
|
|
i f ( c [ 5 ] ! = c [ 4 ] )
|
|||
|
|
m a s k | = 1 < < 4 ;
|
|||
|
|
i f ( c [ 6 ] ! = c [ 4 ] )
|
|||
|
|
m a s k | = 1 < < 5 ;
|
|||
|
|
i f ( c [ 7 ] ! = c [ 4 ] )
|
|||
|
|
m a s k | = 1 < < 6 ;
|
|||
|
|
i f ( c [ 8 ] ! = c [ 4 ] )
|
|||
|
|
m a s k | = 1 < < 7 ;
|
|||
|
|
|
|||
|
|
# d e f i n e P 0 d s t 0 [ 0 ]
|
|||
|
|
# d e f i n e P 1 d s t 0 [ 1 ]
|
|||
|
|
# d e f i n e P 2 d s t 1 [ 0 ]
|
|||
|
|
# d e f i n e P 3 d s t 1 [ 1 ]
|
|||
|
|
# d e f i n e M U R ( c [ 1 ] ! = c [ 5 ] )
|
|||
|
|
# d e f i n e M D R ( c [ 5 ] ! = c [ 7 ] )
|
|||
|
|
# d e f i n e M D L ( c [ 7 ] ! = c [ 3 ] )
|
|||
|
|
# d e f i n e M U L ( c [ 3 ] ! = c [ 1 ] )
|
|||
|
|
# d e f i n e I C ( p 0 ) c [ p 0 ]
|
|||
|
|
# d e f i n e I 1 1 ( p 0 , p 1 ) i n t e r p _ 3 2 _ 1 1 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 2 1 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 3 2 _ 2 1 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 3 1 ( p 0 , p 1 ) i n t e r p _ 3 2 _ 3 1 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 3 3 2 ( p 0 , p 1 , p 2 ) i n t e r p _ 3 2 _ 3 3 2 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 4 3 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 3 2 _ 4 3 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 5 2 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 3 2 _ 5 2 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 5 3 ( p 0 , p 1 ) i n t e r p _ 3 2 _ 5 3 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 6 1 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 3 2 _ 6 1 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 7 1 ( p 0 , p 1 ) i n t e r p _ 3 2 _ 7 1 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 7 7 2 ( p 0 , p 1 , p 2 ) i n t e r p _ 3 2 _ 7 7 2 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 9 7 ( p 0 , p 1 ) i n t e r p _ 3 2 _ 9 7 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
# d e f i n e I 1 4 1 1 ( p 0 , p 1 , p 2 ) i n t e r p _ 3 2 _ 1 4 1 1 ( c [ p 0 ] , c [ p 1 ] , c [ p 2 ] )
|
|||
|
|
# d e f i n e I 1 5 1 ( p 0 , p 1 ) i n t e r p _ 3 2 _ 1 5 1 ( c [ p 0 ] , c [ p 1 ] )
|
|||
|
|
|
|||
|
|
s w i t c h ( m a s k ) {
|
|||
|
|
# i n c l u d e " l q 2 x . h "
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
# u n d e f P 0
|
|||
|
|
# u n d e f P 1
|
|||
|
|
# u n d e f P 2
|
|||
|
|
# u n d e f P 3
|
|||
|
|
# u n d e f M U R
|
|||
|
|
# u n d e f M D R
|
|||
|
|
# u n d e f M D L
|
|||
|
|
# u n d e f M U L
|
|||
|
|
# u n d e f I C
|
|||
|
|
# u n d e f I 1 1
|
|||
|
|
# u n d e f I 2 1 1
|
|||
|
|
# u n d e f I 3 1
|
|||
|
|
# u n d e f I 3 3 2
|
|||
|
|
# u n d e f I 4 3 1
|
|||
|
|
# u n d e f I 5 2 1
|
|||
|
|
# u n d e f I 5 3
|
|||
|
|
# u n d e f I 6 1 1
|
|||
|
|
# u n d e f I 7 1
|
|||
|
|
# u n d e f I 7 7 2
|
|||
|
|
# u n d e f I 9 7
|
|||
|
|
# u n d e f I 1 4 1 1
|
|||
|
|
# u n d e f I 1 5 1
|
|||
|
|
|
|||
|
|
s r c 0 + = 1 ;
|
|||
|
|
s r c 1 + = 1 ;
|
|||
|
|
s r c 2 + = 1 ;
|
|||
|
|
d s t 0 + = 2 ;
|
|||
|
|
d s t 1 + = 2 ;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|