/*
*				Vector演算関数				ver 1.12
*
*	math.h, math2.h を仮定する｡
*/

/*
*		型宣言
*/
struct vect2i { int x ; int y };				/* 二次元整数vector */ 
struct vect3i { int x ; int y ; int z };		/* 三次元整数vector */ 
struct vect3p { int x; int y ; int z }; 		/* 三次元固定少数vector */
struct vect3f { float x ; float y ; float z };	/* 三次元浮動少数vector */
struct matrix3i	{ int xx ; int xy ; int xz ;
                  int yx ; int yy ; int yz ;
                  int zx ; int zy ; int zz ; };	/* ３×３整数行列 */
struct matrix3p	{ int xx ; int xy ; int xz ;
                  int yx ; int yy ; int yz ;
                  int zx ; int zy ; int zz ; };	/* ３×３固定少数行列 */
struct surfi {
	struct vect3i norl;							/* 法線 (NORmal Line) */
	struct vect3i s0;							/* 面上の一点 */
	int c;										/* 定数 */
};
struct surfp {
	struct vect3p norl;							/* 法線 (NORmal Line) */
	struct vect3p s0;							/* 面上の一点 */
	int c;										/* 固定少数の定数 */
};



/*
*		固定少数整数変換関数
*/
extern struct vect3i DeciToInt3V( struct vect3p p );
extern struct vect3p IntToDeci3V( struct vect3i p );
extern struct matrix3i DeciToInt3M( struct matrix3p A );
extern struct matrix3p IntToDeci3M( struct matrix3i A );
/*
*		vector 演算関数
*/
#define MakeZero2i( p )			{ (p).x=0; (p).y=0; }
#define MakeZero2p( p )			{ (p).x=0; (p).y=0; }
extern struct vect2i scalar2i( int, struct vect2i )	;
extern struct vect2i inscalar2i( int, struct vect2i );
extern struct vect2i scalar2p( int, struct vect2i );
extern struct vect2i add2i( struct vect2i, struct vect2i );
extern struct vect2i subtr2i( struct vect2i, struct vect2i );
extern struct vect2i rshift2i( struct vect2i, int );
extern struct vect2i lshift2i( struct vect2i, int );
#define iszero2( p )			( (p).x==0 && (p).y==0 )
#define abs2i( p )				( (int)sqrt( (p).x*(p).x + (p).y*(p).y ) )
#define innerpro2i( p, q )		( (p).x*(q).x + (p).y*(q).y )
#define innerpro2p( p, q )		AdjMulDeci( (p).x*(q).x + (p).y*(q).y )
#define issame2v( p, q )		( (p).x==(q).x && (p).y==(q).y )

#define MakeZero3i( p )			{ (p).x=0; (p).y=0; (p).z=0; }
#define MakeZero3p( p )			{ (p).x=0; (p).y=0; (p).z=0; }
extern struct vect3i scalar3i( int, struct vect3i );
extern struct vect3i scalar3p( int, struct vect3i );
extern struct vect3i inscalar3i( int, struct vect3i );
extern struct vect3i add3i( struct vect3i, struct vect3i );
extern struct vect3p add3p( struct vect3p x1, struct vect3p x2 );
extern struct vect3i subtr3i( struct vect3i, struct vect3i );
extern struct vect3p subtr3p( struct vect3p x1, struct vect3p x2 );
extern struct vect3i outerpro3i( struct vect3i, struct vect3i );
extern struct vect3p outerpro3p( struct vect3p x1, struct vect3p x2 );
extern struct vect3i rshift3i( struct vect3i p, int i );
extern struct vect3i lshift3i( struct vect3i p, int i );
extern struct vect3p rshift3p( struct vect3p p, int i );
extern struct vect3p lshift3p( struct vect3p p, int i );
#define issame3v( p, q )		( (p).x==(q).x && (p).y==(q).y && (p).z==(q).z )
#define ispara3( p, q )			( ( (p).x*(q).y - (p).y*(q).x )==0 && ( (p).x*(q).z - (p).z*(q).x )==0 && ( (p).y*(q).z - (p).z*(q).y )==0 )
#define iszero3( p )			( (p).x==0 && (p).y==0 && (p).z==0 )
#define det3( p, q, r )			( (p).x*(q).y*(r).z + (q).x*(r).y*(p).z + (r).x*(p).y*(q).z - (p).x*(r).y*(q).z - (q).x*(p).y*(r).z - (r).x*(q).y*(p).z )
#define innerpro3i( p, q )		( (p).x*(q).x + (p).y*(q).y + (p).z*(q).z )
#define innerpro3p( p, q )		AdjMulDeci( (p).x*(q).x + (p).y*(q).y + (p).z*(q).z )
#define abs3i( p )				( (int)sqrt( (p).x*(p).x + (p).y*(p).y + (p).z*(p).z ) )
#define Normalize3i( p )		{ if( abs3i(p)>0 ) (p)=inscalar3i( abs3i(p) ,scalar3i( DUNIT, (p) ) );}
/* p の大きさをdunitにする */
#define cos3i( p, q )			( (innerpro3i( p, q ) << DECIMAL) / abs3i(p) / abs3i(q) )
/* p, q のなす角の cos を固定少数で返す */
#define Init3V( p )				{ (p).x=0 ; (p).y=0 ; (p).z=0 ;}

/*
*		行列演算関数
*/
extern struct matrix3i addm3i( struct matrix3i A, struct matrix3i B );
#define addm3p( A, B )			( addm3i( (A), (B) ) )
extern struct matrix3i subm3i( struct matrix3i A, struct matrix3i B );
#define subm3p( A, B )			( subm3i( (A), (B) ) )
extern struct matrix3i mulmm3i( struct matrix3i A, struct matrix3i B );
extern struct matrix3p mulmm3p( struct matrix3p A, struct matrix3p B );
extern struct vect3i mulmv3i( struct matrix3i A, struct vect3i p );
extern struct vect3p mulmv3p( struct matrix3p A, struct vect3p p );
extern struct vect3i mulmv3pi( struct matrix3p A, struct vect3i p );
/* ３次元vectorの回転 */
extern struct vect3i RotXi( int a, struct vect3i p );
extern struct vect3p RotXp( int a, struct vect3p p );
extern struct vect3i RotYi( int a, struct vect3i p );
extern struct vect3p RotYp( int a, struct vect3p p );
extern struct vect3i RotZi( int a, struct vect3i p );
extern struct vect3p RotZp( int a, struct vect3p p );
extern struct matrix3p RotX( int a );
extern struct matrix3p RotY( int a );
extern struct matrix3p RotZ( int a );
#define Init3M( A )				{ (A).xx=0 ; (A).xy=0 ; (A).xz=0 ; (A).yx=0 ; (A).yy=0 ; (A).yz=0 ; (A).zx=0 ; (A).zy=0 ; (A).zz=0 ; }
/* 平面を表す関数 */
#define surffi( s, p )	( innerpro3i( (s).norl, (p) ) - (s).c )
#define surffp( s, p )	( innerpro3p( (s).norl, (p) ) - (s).c )