/ *   
 
   *   P R O J E C T :   N y A R T o o l k i t C S ( E x t e n s i o n ) 
 
   *   - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - 
 
   *   T h e   N y A R T o o l k i t C S   i s   J a v a   e d i t i o n   A R T o o l K i t   c l a s s   l i b r a r y . 
 
   *   C o p y r i g h t   ( C ) 2 0 0 8 - 2 0 0 9   R y o   I i z u k a 
 
   * 
 
   *   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   3   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 ,   s e e   < h t t p : / / w w w . g n u . o r g / l i c e n s e s / > . 
 
   *   
 
   *   F o r   f u r t h e r   i n f o r m a t i o n   p l e a s e   c o n t a c t . 
 
   * 	 h t t p : / / n y a t l a . j p / n y a t o o l k i t / 
 
   * 	 < a i r m a i l ( a t ) e b o n y . p l a l a . o r . j p >   o r   < n y a t l a ( a t ) n y a t l a . j p > 
 
   *   
 
   * / 
 
 u s i n g   S y s t e m ; 
 
 n a m e s p a c e   j p . n y a t l a . n y a r t o o l k i t . c s . c o r e 
 
 { 
 
 
 
 
 
         / * * 
 
           *   S0n0000o00NpX , Y h0	YSϑK000v}0[W0~0Y00
 
           * / 
 
         p u b l i c   c l a s s   N y A R V e c L i n e a r 2 d 
 
         { 
 
                 / * *   v}n0Np( X ) * / 
 
                 p u b l i c   d o u b l e   x ; 
 
                 / * *   v}n0Np( Y ) * / 
 
                 p u b l i c   d o u b l e   y ; 
 
                 / * *   x eTn0v}n0	YSϑ* / 
 
                 p u b l i c   d o u b l e   d x ; 
 
                 / * *   y eTn0v}n0	YSϑ* / 
 
                 p u b l i c   d o u b l e   d y ; 
 
 
 
                 / * * 
 
                   *   S0n0peo00c[000n0000000MR0\O0~0Y00
 
                   *   @ p a r a m   i _ l e n g t h 
 
                   *   \ObY00MRn0wU0
 
                   *   @ r e t u r n 
 
                   *   eW0D0MR0
 
                   * / 
 
                 p u b l i c   s t a t i c   N y A R V e c L i n e a r 2 d [ ]   c r e a t e A r r a y ( i n t   i _ l e n g t h ) 
 
                 { 
 
                         N y A R V e c L i n e a r 2 d [ ]   r   =   n e w   N y A R V e c L i n e a r 2 d [ i _ l e n g t h ] ; 
 
                         f o r   ( i n t   i   =   0 ;   i   <   i _ l e n g t h ;   i + + ) 
 
                         { 
 
                                 r [ i ]   =   n e w   N y A R V e c L i n e a r 2 d ( ) ; 
 
                         } 
 
                         r e t u r n   r ; 
 
                 } 
 
                 / * * 
 
                   *   S0n0peo00l}0{W0~0Y00
 
                   *   Npo0	YfW0~0[000
 
                   *   @ p a r a m   i _ s r c 
 
                   *   CQn00000000c[W0~0Y00S0n0$Pk0o00t h i s 0c[g0M0~0Y00
 
                   * / 
 
                 p u b l i c   v o i d   n o r m a l V e c ( N y A R V e c L i n e a r 2 d   i _ s r c ) 
 
                 { 
 
                         d o u b l e   w   =   t h i s . d x ; 
 
                         t h i s . d x   =   i _ s r c . d y ; 
 
                         t h i s . d y   =   - w ; 
 
                 } 
 
                 / * * 
 
                   *   S0n0peo00000000n0$P0000000k0000W0~0Y00
 
                   *   @ p a r a m   i _ v a l u e 
 
                   *   000CQn0000000
 
                   * / 
 
                 p u b l i c   v o i d   s e t V a l u e ( N y A R V e c L i n e a r 2 d   i _ v a l u e ) 
 
                 { 
 
                         t h i s . d x   =   i _ v a l u e . d x ; 
 
                         t h i s . d y   =   i _ v a l u e . d y ; 
 
                         t h i s . x   =   i _ v a l u e . x ; 
 
                         t h i s . y   =   i _ v a l u e . y ; 
 
                 } 
 
                 / * * 
 
                   *   S0n0peo00S0n0v}h0_pen0v}h0L0\O0C o s $P0ԏW0~0Y00
 
                   *   @ p a r a m   i _ v 1 
 
                   *   v}0<h
}W0_0000000
 
                   *   @ r e t u r n 
 
                   *   v}n0C O S $Pr a d i a n 	
 
                   * / 
 
                 p u b l i c   d o u b l e   g e t V e c C o s ( N y A R V e c L i n e a r 2 d   i _ v 1 ) 
 
                 { 
 
                         d o u b l e   x 1   =   i _ v 1 . d x ; 
 
                         d o u b l e   y 1   =   i _ v 1 . d y ; 
 
                         d o u b l e   x 2   =   t h i s . d x ; 
 
                         d o u b l e   y 2   =   t h i s . d y ; 
 
                         d o u b l e   d   =   ( x 1   *   x 2   +   y 1   *   y 2 )   /   M a t h . S q r t ( ( x 1   *   x 1   +   y 1   *   y 1 )   *   ( x 2   *   x 2   +   y 2   *   y 2 ) ) ; 
 
                         r e t u r n   d ; 
 
                 } 
 
                 / * * 
 
                   *   S0n0peo00S0n0v}h0_pen0v}h0L0\O0C o s $Pn0v}[$P0ԏW0~0Y00
 
                   *   @ p a r a m   i _ v 1 
 
                   *   v}0<h
}W0_0000000
 
                   *   @ r e t u r n 
 
                   *   v}n0C O S $Pn0v}[$Pr a d i a n 	
 
                   * / 
 
                 p u b l i c   d o u b l e   g e t A b s V e c C o s ( N y A R V e c L i n e a r 2 d   i _ v 1 ) 
 
                 { 
 
                         d o u b l e   d   =   g e t V e c C o s ( i _ v 1 ) ; 
 
                         r e t u r n   d   > =   0   ?   d   :   - d ; 
 
                 } 
 
                 / * * 
 
                   *   S0n0peo00S0n0v}h00000L0\O0C o s $P0ԏW0~0Y00
 
                   *   @ p a r a m   i _ d x 
 
                   *   0000n0X bR
 
                   *   @ p a r a m   i _ d y 
 
                   *   0000n0Y bR
 
                   *   @ r e t u r n 
 
                   *   v}n0C O S $Pr a d i a n 	
 
                   * / 
 
                 p u b l i c   d o u b l e   g e t V e c C o s ( d o u b l e   i _ d x ,   d o u b l e   i _ d y ) 
 
                 { 
 
                         d o u b l e   x 1   =   t h i s . d x ; 
 
                         d o u b l e   y 1   =   t h i s . d y ; 
 
                         r e t u r n   ( x 1   *   i _ d x   +   y 1   *   i _ d y )   /   M a t h . S q r t ( ( x 1   *   x 1   +   y 1   *   y 1 )   *   ( i _ d x   *   i _ d x   +   i _ d y   *   i _ d y ) ) ; 
 
                 } 
 
                 / * * 
 
                   *   S0n0peo00S0n0v}h00000L0\O0C o s $Pn0v}[$P0ԏW0~0Y00
 
                   *   @ p a r a m   i _ v 2 _ x 
 
                   *   0000n0X bR
 
                   *   @ p a r a m   i _ v 2 _ y 
 
                   *   0000n0Y bR
 
                   *   @ r e t u r n 
 
                   *   v}n0C O S $Pn0v}[$Pr a d i a n 	
 
                   * / 
 
                 p u b l i c   d o u b l e   g e t A b s V e c C o s ( d o u b l e   i _ v 2 _ x ,   d o u b l e   i _ v 2 _ y ) 
 
                 { 
 
                         d o u b l e   d   =   g e t V e c C o s ( i _ v 2 _ x ,   i _ v 2 _ y ) ; 
 
                         r e t u r n   d   > =   0   ?   d   :   - d ; 
 
                 } 
 
                 / * * 
 
                   *   S0n0peo00S0n0v}h0}RL0\O0C o s $P0ԏW0~0Y00
 
                   *   @ p a r a m   i _ p o s 1 
 
                   *   }Rn0zp
 
                   *   @ p a r a m   i _ p o s 2 
 
                   *   }Rn0zp
 
                   *   @ r e t u r n 
 
                   *   v}n0C O S $Pr a d i a n 	
 
                   * / 
 
                 p u b l i c   d o u b l e   g e t V e c C o s ( N y A R D o u b l e P o i n t 2 d   i _ p o s 1 ,   N y A R D o u b l e P o i n t 2 d   i _ p o s 2 ) 
 
                 { 
 
                         r e t u r n   g e t V e c C o s ( i _ p o s 2 . x   -   i _ p o s 1 . x ,   i _ p o s 2 . y   -   i _ p o s 1 . y ) ; 
 
                 } 
 
 
 
                 / * * 
 
                   *   S0n0peo00S0n0v}h0}RL0\O0C o s $Pn0v}[$P0ԏW0~0Y00
 
                   *   @ p a r a m   i _ p o s 1 
 
                   *   }Rn0zp
 
                   *   @ p a r a m   i _ p o s 2 
 
                   *   }Rn0zp
 
                   *   @ r e t u r n 
 
                   *   v}n0C O S $Pn0v}[$Pr a d i a n 	
 
                   * / 
 
                 p u b l i c   d o u b l e   g e t A b s V e c C o s ( N y A R D o u b l e P o i n t 2 d   i _ p o s 1 ,   N y A R D o u b l e P o i n t 2 d   i _ p o s 2 ) 
 
                 { 
 
                         r e t u r n   g e t A b s V e c C o s ( i _ p o s 2 . x   -   i _ p o s 1 . x ,   i _ p o s 2 . y   -   i _ p o s 1 . y ) ; 
 
                 } 
 
 
 
                 / * * 
 
                   *   S0n0peo00v}h0n0Np0Bl0~0Y00
 
                   *   @ p a r a m   i _ v e c t o r 1 
 
                   *   Np0Bl00v}
 
                   *   @ p a r a m   o _ p o i n t 
 
                   *   Np^j0_00000000
 
                   *   @ r e t u r n 
 
                   *   NpL0Bl~00h00t r u e 0ԏW0~0Y00
 
                   * / 
 
                 p u b l i c   b o o l   c r o s s P o s ( N y A R V e c L i n e a r 2 d   i _ v e c t o r 1 ,   N y A R D o u b l e P o i n t 2 d   o _ p o i n t ) 
 
                 { 
 
                         d o u b l e   a 1   =   i _ v e c t o r 1 . d y ; 
 
                         d o u b l e   b 1   =   - i _ v e c t o r 1 . d x ; 
 
                         d o u b l e   c 1   =   ( i _ v e c t o r 1 . d x   *   i _ v e c t o r 1 . y   -   i _ v e c t o r 1 . d y   *   i _ v e c t o r 1 . x ) ; 
 
                         d o u b l e   a 2   =   t h i s . d y ; 
 
                         d o u b l e   b 2   =   - t h i s . d x ; 
 
                         d o u b l e   c 2   =   ( t h i s . d x   *   t h i s . y   -   t h i s . d y   *   t h i s . x ) ; 
 
                         d o u b l e   w 1   =   a 1   *   b 2   -   a 2   *   b 1 ; 
 
                         i f   ( w 1   = =   0 . 0 ) 
 
                         { 
 
                                 r e t u r n   f a l s e ; 
 
                         } 
 
                         o _ p o i n t . x   =   ( b 1   *   c 2   -   b 2   *   c 1 )   /   w 1 ; 
 
                         o _ p o i n t . y   =   ( a 2   *   c 1   -   a 1   *   c 2 )   /   w 1 ; 
 
                         r e t u r n   t r u e ; 
 
                 } 
 
                 / * * 
 
                   *   S0n0peo00S0n0v}h00i _ s p 1 h0i _ s p 2 n0\O0}Rh0n00NWNݍ$Pn0T0ԏW0~0Y00
 
                   *   {elo00}Rn0zp0NY00v}n0l}
Ng0n00zph0v}n0ݍn0Tg0Y00
 
                   *   }Rh0v}n0^<O^0$R[Y00pe$Pk0j00~0Y00
 
                   *   @ p a r a m   i _ s p 1 
 
                   *   }Rn0zp1 
 
                   *   @ p a r a m   i _ s p 2 
 
                   *   }Rn0zp2 
 
                   *   @ r e t u r n 
 
                   *   NWNݍ$Pn0T0ݍL0S0j0D0h0M0o0!qP'Yg0Y00
 
                   * / 
 
                 p u b l i c   d o u b l e   s q D i s t B y S e g m e n t L i n e E d g e ( N y A R D o u b l e P o i n t 2 d   i _ s p 1 ,   N y A R D o u b l e P o i n t 2 d   i _ s p 2 ) 
 
                 { 
 
                         d o u b l e   s a ,   s b ,   s c ; 
 
                         s a   =   t h i s . d y ; 
 
                         s b   =   - t h i s . d x ; 
 
                         s c   =   ( t h i s . d x   *   t h i s . y   -   t h i s . d y   *   t h i s . x ) ; 
 
 
 
 
 
                         d o u b l e   l c ; 
 
                         d o u b l e   x ,   y ,   w 1 ; 
 
                         / / t h i s 0l}k0	Yc
 
 
 
                         / / Np0{
 
                         w 1   =   s a   *   ( - s a )   -   s b   *   s b ; 
 
                         i f   ( w 1   = =   0 . 0 ) 
 
                         { 
 
                                 r e t u r n   D o u b l e . P o s i t i v e I n f i n i t y ; 
 
                         } 
 
                         / / i _ s p 1 h00i _ l i n e r n0Np
 
                         l c   =   - ( s b   *   i _ s p 1 . x   -   s a   *   i _ s p 1 . y ) ; 
 
                         x   =   ( ( s b   *   l c   +   s a   *   s c )   /   w 1 )   -   i _ s p 1 . x ; 
 
                         y   =   ( ( s b   *   s c   -   s a   *   l c )   /   w 1 )   -   i _ s p 1 . y ; 
 
                         d o u b l e   s q d i s t   =   x   *   x   +   y   *   y ; 
 
 
 
                         l c   =   - ( s b   *   i _ s p 2 . x   -   s a   *   i _ s p 2 . y ) ; 
 
                         x   =   ( ( s b   *   l c   +   s a   *   s c )   /   w 1 )   -   i _ s p 2 . x ; 
 
                         y   =   ( ( s b   *   s c   -   s a   *   l c )   /   w 1 )   -   i _ s p 2 . y ; 
 
 
 
                         r e t u r n   s q d i s t   +   x   *   x   +   y   *   y ; 
 
                 } 
 
 
 
                 / * * 
 
                   *   S0n0peo00i _ l i n e n0v}00000000k0000W0~0Y00
 
                   *   { @ l i n k   # x } , { @ l i n k   # y } n0$Po00( i _ x , i _ y ) 0NY00i _ l i n e n0l}h0i _ l i n e n0Np0000W0~0Y00
 
                   *   @ p a r a m   i _ l i n e 
 
                   *   000Y00v}_
 
                   *   @ p a r a m   i _ x 
 
                   *   { @ l i n k   # x } , { @ l i n k   # y } 0x[Y00_00n00l}n0Np
 
                   *   @ p a r a m   i _ y 
 
                   *   { @ l i n k   # x } , { @ l i n k   # y } 0x[Y00_00n00l}n0Np
 
                   *   @ r e t u r n 
 
                   *   000k0bRY00h00t r u e 0ԏW0~0Y00
 
                   * / 
 
                 p u b l i c   b o o l   s e t L i n e a r ( N y A R L i n e a r   i _ l i n e ,   d o u b l e   i _ x ,   d o u b l e   i _ y ) 
 
                 { 
 
                         d o u b l e   l a   =   i _ l i n e . b ; 
 
                         d o u b l e   l b   =   - i _ l i n e . a ; 
 
                         d o u b l e   l c   =   - ( l a   *   i _ x   +   l b   *   i _ y ) ; 
 
                         / / Np0{
 
                         d o u b l e   w 1   =   - l b   *   l b   -   l a   *   l a ; 
 
                         i f   ( w 1   = =   0 . 0 ) 
 
                         { 
 
                                 r e t u r n   f a l s e ; 
 
                         } 
 
                         t h i s . x   =   ( ( l a   *   l c   -   l b   *   i _ l i n e . c )   /   w 1 ) ; 
 
                         t h i s . y   =   ( ( l a   *   i _ l i n e . c   +   l b   *   l c )   /   w 1 ) ; 
 
                         t h i s . d y   =   - l b ; 
 
                         t h i s . d x   =   - l a ; 
 
                         r e t u r n   t r u e ; 
 
                 } 
 
                 / * * 
 
                   *   S0n0peo00pK00 g\NWNl0O(uW0f0v}0{W0~0Y00
 
                   *   @ p a r a m   i _ p o i n t s 
 
                   *   p0<h
}W0_0MR0
 
                   *   @ p a r a m   i _ n u m b e r _ o f _ d a t a 
 
                   *   {[an0pn0pe
 
                   *   @ r e t u r n 
 
                   *   {k0bRY00h00t r u e 0ԏW0~0Y00
 
                   * / 
 
                 p u b l i c   b o o l   l e a s t S q u a r e s ( N y A R D o u b l e P o i n t 2 d [ ]   i _ p o i n t s ,   i n t   i _ n u m b e r _ o f _ d a t a ) 
 
                 { 
 
                         i n t   i ; 
 
                         d o u b l e   s u m _ x y   =   0 ,   s u m _ x   =   0 ,   s u m _ y   =   0 ,   s u m _ x 2   =   0 ; 
 
                         f o r   ( i   =   0 ;   i   <   i _ n u m b e r _ o f _ d a t a ;   i + + ) 
 
                         { 
 
                                 N y A R D o u b l e P o i n t 2 d   p t r   =   i _ p o i n t s [ i ] ; 
 
                                 d o u b l e   x w   =   p t r . x ; 
 
                                 s u m _ x y   + =   x w   *   p t r . y ; 
 
                                 s u m _ x   + =   x w ; 
 
                                 s u m _ y   + =   p t r . y ; 
 
                                 s u m _ x 2   + =   x w   *   x w ; 
 
                         } 
 
                         d o u b l e   l a   =   - ( i _ n u m b e r _ o f _ d a t a   *   s u m _ x 2   -   s u m _ x   *   s u m _ x ) ; 
 
                         d o u b l e   l b   =   - ( i _ n u m b e r _ o f _ d a t a   *   s u m _ x y   -   s u m _ x   *   s u m _ y ) ; 
 
                         d o u b l e   c c   =   ( s u m _ x 2   *   s u m _ y   -   s u m _ x y   *   s u m _ x ) ; 
 
                         d o u b l e   l c   =   - ( l a   *   s u m _ x   +   l b   *   s u m _ y )   /   i _ n u m b e r _ o f _ d a t a ; 
 
                         / / Np0{
 
                         d o u b l e   w 1   =   - l b   *   l b   -   l a   *   l a ; 
 
                         i f   ( w 1   = =   0 . 0 ) 
 
                         { 
 
                                 r e t u r n   f a l s e ; 
 
                         } 
 
                         t h i s . x   =   ( ( l a   *   l c   -   l b   *   c c )   /   w 1 ) ; 
 
                         t h i s . y   =   ( ( l a   *   c c   +   l b   *   l c )   /   w 1 ) ; 
 
                         t h i s . d y   =   - l b ; 
 
                         t h i s . d x   =   - l a ; 
 
                         r e t u r n   t r u e ; 
 
                 } 
 
                 / * * 
 
                   *   S0n0peo00ckSW0_000000QRY000{ @ l i n k   # l e a s t S q u a r e s } g0Y00
 
                   *   @ p a r a m   i _ p o i n t s 
 
                   *   p0<h
}W0_0MR0
 
                   *   @ p a r a m   i _ n u m b e r _ o f _ d a t a 
 
                   *   {[an0pn0pe
 
                   *   @ r e t u r n 
 
                   *   {k0bRY00h00t r u e 0ԏW0~0Y00
 
                   * / 
 
                 p u b l i c   b o o l   l e a s t S q u a r e s W i t h N o r m a l i z e ( N y A R D o u b l e P o i n t 2 d [ ]   i _ p o i n t s ,   i n t   i _ n u m b e r _ o f _ d a t a ) 
 
                 { 
 
                         b o o l   r e t   =   t h i s . l e a s t S q u a r e s ( i _ p o i n t s ,   i _ n u m b e r _ o f _ d a t a ) ; 
 
                         d o u b l e   s q   =   1   /   M a t h . S q r t ( t h i s . d x   *   t h i s . d x   +   t h i s . d y   *   t h i s . d y ) ; 
 
                         t h i s . d x   * =   s q ; 
 
                         t h i s . d y   * =   s q ; 
 
                         r e t u r n   r e t ; 
 
                 } 
 
         } 
 
 } 