//■3D座標変換例
#include "myWin.h"
#include "my3Dmat.h"
#include "stdio.h"
#include "stdlib.h"
#include "locale.h"
#define LWIDTH 4 //線幅
#define AWIDTH 2 //軸の線幅
// ラベル
#define LB_1 1001 // 方位角
#define LB_2 1002 // 仰角
#define LB_3 1003 // 距離
// エディットボックス
#define ED_1 2001 // 方位角 
#define ED_2 2002 // 仰角
#define ED_3 2003 // 距離
// ボタン
#define BT_1 3001 // 平行移動
#define BT_2 3002 // 回転移動
#define BT_3 3003 // スケーリング
#define BT_4 3004 // 対称変換
#define BT_5 3005 // 任意軸回転
#define BT_6 3006 // 透視変換

float mu=-1, a=0.008F, b=0.05F,dm= 0.0005F;//写像用変数
static HWND btPara, btRota, btScale, btMirror, btAxis, btView; 
static HWND editA, editB, editC;//透視変換用
static HDC hbuf; static HBITMAP hBM;//ビットマップ描画用
// 立体表示用
Point org;
TMatrix t;
Point v0;
double size_x;
double size_y;
void clearBitmap(){
	SelectObject(hbuf,GetStockObject(NULL_PEN));
	PatBlt(hbuf,0,0,2000,1000,WHITENESS);
}
void setView(double a,double e, double d)//視点設定
{
	Point P1=setPoint(0,0,1);
	TMatrix PP=perspect(d), RX=rot_x(e-90), RZ=rot_z(-90-a);
	t=mlt(mlt(perspect(d),rot_x(e-90)),rot_z(-90-a));
	v0=mlt(mlt(rot_z(90+a),rot_x(90-e)),mlt(P1,d));
}
Point screen(Point p){
	Point a=mlt(t,p);
	double s=(t.mat[3][0]*p.X+t.mat[3][1]*p.Y+t.mat[3][2]*p.Z+t.mat[3][3]);
	return setPoint(org.X+a.X/s,org.Y-a.Y/s,a.Z);
}
void init2D(int x, int y){
	size_x=x; size_y=y;
	org.X=size_x/2-0.5;	org.Y=size_y/2-1.5; org.Z=0;
	setView(30,30,1000);
}
void drawLine(double X1, double Y1, double X2, double Y2){
	MoveToEx(hbuf,(int)(X1+0.5),(int)(Y1+0.5),NULL);
	LineTo(hbuf,(int)(X2+0.5),(int)(Y2+0.5));
}
void drawString(double X1, double Y1, TCHAR AX[]){
	TextOut(hbuf, (int)(X1+0.5),(int)(Y1+0.5),AX, lstrlen(AX));
}
void drawAxis(TCHAR AX[], Point P1, Point P2){
	Point PP1 = screen(P1);	Point PP2 = screen(P2);
	drawLine(PP1.X, PP1.Y, PP2.X, PP2.Y);
	drawString(PP2.X+4, PP2.Y, AX);
}
void drawAxis(){
	HPEN pen = CreatePen(PS_SOLID,AWIDTH, 0);SelectObject(hbuf,pen);
	HBRUSH brush=CreateSolidBrush(0xFF0000);SelectObject(hbuf,brush);
	HFONT font=CreateFont(10, 0,0,0,FW_NORMAL,TRUE,FALSE,FALSE,SHIFTJIS_CHARSET,
		OUT_DEFAULT_PRECIS,CLIP_DEFAULT_PRECIS,DEFAULT_QUALITY,
		FIXED_PITCH |FF_MODERN,NULL);SelectObject(hbuf,font);
	drawAxis(TEXT("X"),setPoint(-size_x/2,0,0), setPoint(size_x/2,0,0));
	drawAxis(TEXT("Y"),setPoint(0,-size_x/2,0), setPoint(0,size_x/2*0.9,0));
	drawAxis(TEXT("Z"),setPoint(0,0,-size_y/2), setPoint(0,0,size_y/2));
	DeleteObject(brush);DeleteObject(pen);DeleteObject(font);
}
void drawLine(Point P1, Point P2, int C)
{
	HPEN pen = CreatePen(PS_SOLID,LWIDTH, C);SelectObject(hbuf,pen);
	Point PP1 = screen(P1), PP2 = screen(P2);
	drawLine( PP1.X, PP1.Y, PP2.X, PP2.Y);
	DeleteObject(pen);
}
void drawLineDot(Point P1, Point P2, int C) {
	HPEN pen = CreatePen(PS_DOT,1, C);SelectObject(hbuf,pen);
	Point PP1 = screen(P1), PP2 = screen(P2);
	drawLine( PP1.X, PP1.Y, PP2.X, PP2.Y);
	DeleteObject(pen);
}	
void drawLine(Line LDT,int C){
	Point P1=LDT.p[0];
	for(int i=1;i<LDT.n;i++){
		Point P2=LDT.p[i]; drawLine(P1, P2, C);	P1=P2;
	}
}
void origin(int x, int y){
	org = setPoint(x+0.5F , y-0.5F,0);
}
void paraMove(){ //平行移動
	init2D(500,500); origin(250,300);
	drawAxis();
	Line lineDT= setLine(setPoint(0,100),setPoint(40,0),setPoint(60,0),setPoint(100,100),
				 setPoint(80,100),setPoint(55,40),setPoint(30,100),setPoint(0,100));
	drawLine(lineDT, 0xFF0000);     //変換前線分表示
	TMatrix TM;	Line LDT;
	TM=setTMatrix
			    ( 1, 0, 0,   0,                //Z方向に100移動する変換行列設定    
				  0, 1, 0,   0,
				  0, 0, 1, 100,
				  0, 0, 0,   1);
	LDT=mlt(TM,lineDT);                     //変換
	drawLine(LDT, 0xFF);          //変換後線分表示   
	TM= setTMatrix
				( 1, 0, 0, -100,                //X方向に-100移動する変換行列設定    
				  0, 1, 0,    0,
				  0, 0, 1,    0,
				  0, 0, 0,    1);
	LDT=mlt(TM,lineDT);                     //変換
	drawLine(LDT, 0xFF00);        //変換後線分表示   
}
void rotMove(){
	init2D(500,500); origin(250,300); drawAxis();
	Line lineDT= setLine(setPoint(0,100),setPoint(40,0),setPoint(60,0),setPoint(100,100),
				setPoint(80,100),setPoint(55,40),setPoint(30,100),setPoint(0,100));
	drawLine(lineDT, 0xFF0000);    //変換前線分表示
	double PIR=3.14159265359/180;
	double TH=PIR*90, sinTH=sin(TH), cosTH= cos(TH);// 90°回転変換行列設定
	TMatrix	TM= setTMatrix
				( cosTH, -sinTH, 0,   0,       //Z軸回転の変換行列設定　　
				  sinTH,  cosTH, 0,   0,
				      0,      0, 1,   0,
				      0,      0, 0,   1);
	Line LDT=mlt(TM,lineDT); drawLine(LDT, 0xFF);  //変換後線分表示   
	TH=PIR*90; sinTH=sin(TH); cosTH=cos(TH);   // 90°回転変換行列設定
	TM= setTMatrix
				( 1,     0,      0, 0,         //　X軸回転の変換行列設定　　
				  0, cosTH, -sinTH, 0,
				  0, sinTH,  cosTH, 0,
				  0,     0,      0, 1);
	LDT=mlt(TM,lineDT); drawLine(LDT, 0xFF00);  //変換後線分表示   
}
void mirrorMove()
{
	init2D(500,500);origin(250,300); drawAxis();
	Line lineDT= setLine(setPoint(0,100),setPoint(40,0),setPoint(60,0),setPoint(100,100),
				setPoint(80,100),setPoint(55,40),setPoint(30,100),setPoint(0,100));
	drawLine(lineDT, 0xFF0000);    //変換前線分表示
	TMatrix TM= setTMatrix
			 ( -1, 0, 0, 0,        //Y軸対称の変換行列設定　　
				0, 1, 0, 0,
				0, 0, 1, 0,
				0, 0, 0, 1);
	Line LDT=mlt(TM,lineDT); drawLine(LDT, 0xFF);          //変換後線分表示   
	TM= setTMatrix
				( -1,  0, 0, 0,                //Z軸対称の変換行列設定　　
				0, -1, 0, 0,
				0,  0, 1, 0,
				0,  0, 0, 1);
	LDT=mlt(TM,lineDT); drawLine(LDT, 0xFF00);        //変換後線分表示   
}
void scaleMove()
{
	init2D(500,500);origin(250,300); drawAxis();
	Line lineDT= setLine(setPoint(0,100),setPoint(40,0),setPoint(60,0),setPoint(100,100),
				setPoint(80,100),setPoint(55,40),setPoint(30,100),setPoint(0,100));
	drawLine(lineDT, 0xFF0000);    //変換前線分表示
	TMatrix TM= setTMatrix
				( 2, 0, 0, 0,     //各方向に2倍の変換行列設定　　
				  0, 2, 0, 0,
				  0, 0, 2, 0,
				  0, 0, 0, 1);
	Line LDT=mlt(TM,lineDT); drawLine(LDT, 0xFF);          //変換後線分表示   
	TM= setTMatrix
				( 0.5f,    0, 0, 0,           //X方向0.5倍，y方向1.5倍の変換行列設定　　
                  0,    1.5F, 0, 0,
				  0,       0, 1, 0,
				  0,       0, 0, 1);
	LDT=mlt(TM,lineDT); drawLine(LDT, 0xFF00);        //変換後線分表示   
}

void axisMove()
{
	init2D(500,500);origin(250,300); drawAxis();
	Line lineDT= setLine(setPoint(0,100),setPoint(40,0),setPoint(60,0),setPoint(100,100),
				setPoint(80,100),setPoint(55,40),setPoint(30,100),setPoint(0,100));
	Point P=setPoint(50,70,0); TMatrix moveP=move(P);
	lineDT =mlt(moveP,lineDT);
	drawLineDot(setPoint(50,  0,0), setPoint( 50,170,0),0);
	drawLineDot(setPoint( 0,170,0), setPoint(150,170,0),0);
	drawLineDot(setPoint( 0, 70,0), setPoint(150,70,0),0);
	drawLineDot(setPoint( 150, 0,0),setPoint(150,170,0),0);
	
	drawLine(lineDT, 0xFF0000);	//変換前線分表示
			
	Point a=unit(setPoint(2,1,0));
	drawLine(mlt(a,0), mlt(a, 200), 0x770077);
    Point axy=unit(setPoint(a.X, a.Y, 0));
	TMatrix t1=rot_z(-axy.Y, axy.X);
	TMatrix t5=rot_z( axy.Y, axy.X);
			
    Point axz=mlt(t1, unit(a));

	TMatrix t2=rot_y( axz.Z, axz.X), t4=rot_y(-axz.Z, axz.X), t3 = rot_x(30);
	TMatrix t54 = mlt(t5, t4), t32=mlt(t3,t2); Line t1DT=mlt(t1,lineDT);		
	drawLine(mlt(mlt(t54, t32), t1DT), 0xFF);
            
	TMatrix t=mlt(mlt(t54, t32),t1); drawLine(mlt(t,lineDT), 0xFF);			
    t3=rot_x(60); t32=mlt(t3,t2); t=mlt(mlt(t54,t32),t1);
	drawLine(mlt(t,lineDT), 0xFF00);			
}
void viewMove(double V1, double V2, double DL)
{
	init2D(400,400); origin(250,300); setView(V1,V2,DL); drawAxis();
	Line L1= setLine
				(setPoint(-1, 1, 1),setPoint( 1, 1, 1)
				,setPoint( 1, 1,-1),setPoint(-1, 1,-1)
				,setPoint(-1, 1, 1),setPoint(-1,-1, 1));
	Line L2= setLine
				(setPoint(-1,-1, 1),setPoint( 1,-1, 1)
				,setPoint( 1, 1, 1),setPoint( 1, 1,-1)
				,setPoint( 1,-1,-1),setPoint( 1,-1, 1));
	drawLine(mlt(50,L1), 0x0000FF);
	drawLine(mlt(50,L2), 0xFF0000);
}
void createLabel(HWND hw, LPARAM lp, HMENU hm, int X, int Y,TCHAR *str){//ラベル生成
	CreateWindow(TEXT("STATIC"),str,
		WS_CHILD|WS_VISIBLE|SS_RIGHT, X,Y,50,20,hw,hm,
		hInstance, NULL);
}
HWND createEdit(HWND hw, LPARAM lp,HMENU hm, int X, int Y, TCHAR *str){//エディットボックス生成
	return CreateWindow(TEXT("EDIT"),str, 
		WS_CHILD|WS_VISIBLE|WS_BORDER|ES_RIGHT, 
		X,Y,70,20,hw,hm,hInstance, NULL);
}
HWND createButton(HWND hw, LPARAM lp,HMENU hm, int X, int Y, TCHAR str[]){//ボタン生成
	return CreateWindow(TEXT("BUTTON"),str,
		WS_CHILD|WS_VISIBLE|WS_BORDER|BS_PUSHBUTTON, 
		X,Y,140,30,hw,hm,hInstance, NULL);
}
void createBitmap(HWND hw){
	HDC hdc=GetDC(hw); hBM=CreateCompatibleBitmap(hdc,500,700);
	hbuf=CreateCompatibleDC(hdc);SelectObject(hbuf,hBM);
	ReleaseDC(hw, hdc);
}
void windowSize(HWND hw, int width,int height){
	RECT r;	GetWindowRect(hw, &r);
	MoveWindow(hw, r.left, r.top, width, height,TRUE);
}
void initBitMap(HWND hw){// ビットマップ作成とメモリデバイスコンテキスト作成
	createBitmap(hw);
	SelectObject(hbuf,GetStockObject(NULL_PEN));
	clearBitmap();
	windowSize(hw,700,600);
}
void procCreate(HWND hw, WPARAM wp, LPARAM lp){
	initBitMap(hw);
	SetWindowText(hw,TEXT("立体座標変換"));
	createLabel(hw,lp,(HMENU) LB_1,500,245,TEXT("方位角"));//ラベル生成
	createLabel(hw,lp,(HMENU) LB_2,500,285,TEXT("仰角"));
	createLabel(hw,lp,(HMENU) LB_3,500,320,TEXT("距離"));
	editA=createEdit(hw,lp,(HMENU) ED_1,570,245,TEXT("30"));//エディットボックス生成
	editB=createEdit(hw,lp,(HMENU) ED_2,570,285,TEXT("30"));
	editC=createEdit(hw,lp,(HMENU) ED_3,570,320,TEXT("300"));
	btPara   =createButton(hw,lp,(HMENU) BT_1,500, 5,TEXT("平行移動"));//ボタン生成
	btRota   =createButton(hw,lp,(HMENU) BT_2,500,45,TEXT("回転移動"));
	btScale  =createButton(hw,lp,(HMENU) BT_3,500,85,TEXT("スケーリング"));
	btMirror =createButton(hw,lp,(HMENU) BT_4,500,125,TEXT("対称変換"));
	btAxis   =createButton(hw,lp,(HMENU) BT_5,500,165,TEXT("任意軸回転"));
	btView   =createButton(hw,lp,(HMENU) BT_6,500,205,TEXT("透視変換"));
}
float getValue(HWND editBox){//エディットボックスの値を取り出す。
	TCHAR str[128];char ansi[256];double X;
	GetWindowText(editBox,str,127);//文字列を取り出し
	WideCharToMultiByte(CP_ACP, 0, str,-1,ansi,255,NULL,NULL);//char配列に変換
	sscanf(ansi,"%lf",&X); //浮動小数点変換
	return (float)X;
}
void procPaint(HWND hw, WPARAM wp, LPARAM lp){//ビットマップを画面に表示
	PAINTSTRUCT ps; HDC hdc=BeginPaint(hw, &ps);
	BitBlt(hdc,0,0,500,500,hbuf,0,0,SRCCOPY);
	EndPaint(hw,&ps);
}
void comment(TCHAR str[]){
	HBRUSH brush=CreateSolidBrush(0xFF0000);SelectObject(hbuf,brush);
	HFONT font=CreateFont(10, 0,0,0,FW_NORMAL,FALSE,FALSE,FALSE,SHIFTJIS_CHARSET,
		OUT_DEFAULT_PRECIS,CLIP_DEFAULT_PRECIS,DEFAULT_QUALITY,
		FIXED_PITCH |FF_MODERN,NULL);SelectObject(hbuf,font);
	TextOut(hbuf,2,2,str, lstrlen(str));
}
void comment1(){
	comment(TEXT("青色が元のデータ。他の色は変換結果です。"));
}
void comment2(){
	comment(TEXT("パラメータを変更してみましょう。"));
}
void procPara(HWND hw){//平行移動
	clearBitmap(); comment1();
	paraMove();	InvalidateRect(hw, NULL, TRUE);
}
void procRot(HWND hw){//回転移動
	clearBitmap(); comment1();
	rotMove(); InvalidateRect(hw, NULL, TRUE);
}
void procScale(HWND hw){//スケール移動
	clearBitmap(); comment1();
	scaleMove(); InvalidateRect(hw, NULL, TRUE);
}
void procMirror(HWND hw){//対称移動
	clearBitmap(); comment1();
	mirrorMove(); InvalidateRect(hw, NULL, TRUE);
}
void procAxis(HWND hw){//任意の軸周り
	clearBitmap(); comment1();
	axisMove(); InvalidateRect(hw, NULL, TRUE);
}
void procView(HWND hw){//視点の位置
	clearBitmap(); comment2();
	double V1= getValue(editA), V2= getValue(editB), DL= getValue(editC);
	viewMove(V1, V2,DL); InvalidateRect(hw, NULL, TRUE);
}
void procCommand(HWND hw, WPARAM wp, LPARAM lp){
	switch(LOWORD(wp)){
	case BT_1: procPara(hw);return;//平行移動
	case BT_2: procRot(hw) ;return;//回転移動
	case BT_3: procScale(hw) ;return;//スケール拡大・縮小
	case BT_4: procMirror(hw) ;return;//対称移動（鏡）
	case BT_5: procAxis(hw) ;return;//対称移動（鏡）
	case BT_6: procView(hw) ;return;//対称移動（鏡）
	}
}
LRESULT CALLBACK WndProc(HWND hw, UINT msg, WPARAM wp, LPARAM lp){
	switch(msg){
	case WM_DESTROY : PostQuitMessage(0)    ; return 0;
	case WM_CREATE  : procCreate (hw, wp, lp); return 0;
	case WM_PAINT   : procPaint  (hw, wp, lp); return 0;
	case WM_COMMAND : procCommand(hw, wp, lp);
	}
	return DefWindowProc(hw, msg, wp, lp);
}