GLMap/camera.cpp at release · aash29/GLMap · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
#include "camera.hpp"
#include <iostream>
#include "graphics.hpp"

float geoRatio = 1.f;
Camera g_camera;
glm::vec2 Camera::ConvertScreenToWorld(const glm::vec2 &ps) {
	float w = float(m_width);
	float h = float(m_height);
	float u =  ps.x / w;
	float v =  (h - ps.y) / h;

	float ratio =geoRatio * w / h;
	glm::vec2 extents(ratio * m_span, m_span);


	extents *= m_zoom;

	glm::vec2 lower = m_center - extents;
	glm::vec2 upper = m_center + extents;


	glm::vec2 pw;


	pw.x =  (1.0f - u) * lower.x + u * upper.x;
	pw.y =  (1.0f - v) * lower.y + v * upper.y;


	//glm::vec4 uvr = glm::inverse(trans)*glm::vec4(u,v,0.f,1.f);


	glm::mat4 translate1 = glm::translate(glm::mat4(1.f),glm::vec3(-g_camera.m_center.x,-g_camera.m_center.y,0.f));

	glm::mat4 rotN = glm::rotate(glm::mat4(1.f), glm::radians(angleNorth), glm::vec3(0.0f, 0.0f, 1.0f));

	glm::mat4 translate2 =  glm::translate(glm::mat4(1.f),glm::vec3(g_camera.m_center.x,g_camera.m_center.y,0.f));


	glm::mat4 view = glm::mat4(1.f);
	glm::mat4 projection = glm::ortho(lower.x,upper.x,lower.y,upper.y,-1.f,1.f);
	glm::vec4 viewport = glm::vec4(0, 0, w, h);
	glm::vec3 wincoord = glm::vec3(ps.x, h - ps.y, 0.0f);
	glm::vec3 objcoord = glm::unProject(wincoord, translate2*rotN*translate1*view, projection, viewport);
	//glm::vec4 res = rotN*glm::vec4(objcoord,1.f);

	//return glm::vec2(res.x,res.y);

	return objcoord;

//return glm::vec2(uvr.x,uvr.y);

	//return pw;
}

//
glm::vec2 Camera::ConvertWorldToScreen(const glm::vec2 &pw) {
	float w = float(m_width);
	float h = float(m_height);
	float ratio = geoRatio* w / h;
	glm::vec2 extents(ratio * m_span, m_span);
	extents *= m_zoom;

	glm::vec2 lower = m_center - extents;
	glm::vec2 upper = m_center + extents;

	float u = (pw.x - lower.x) / (upper.x - lower.x);
	float v = (pw.y - lower.y) / (upper.y - lower.y);

	glm::vec2 ps;
	ps.x = u * w;
	ps.y = (1.0f - v) * h;

	//glm::mat2 r1 (cos(-angleNorth), -sin(-angleNorth), sin(-angleNorth), cos(-angleNorth) );
	return ps;
}

// Convert from world coordinates to normalized device coordinates.
// http://www.songho.ca/opengl/gl_projectionmatrix.html
glm::mat4 Camera::BuildProjectionMatrix() {
	float w = float(m_width);
	float h = float(m_height);

	//std::cout << w << "," << h << "\n";

	float ratio =  geoRatio* w / h;

	glm::vec2 extents(ratio * m_span, m_span);
	extents *= m_zoom;

	glm::vec2 lower = m_center - extents;
	glm::vec2 upper = m_center + extents;

	glm::mat4 Model = glm::ortho(lower.x,upper.x,lower.y,upper.y,-1.f,1.f);

	//std::cout << lower.x << "," << upper.x << "," << lower.y << "," << upper.y << "\n";

	return Model;


	/*
	m[0] = 2.0f / (upper.x - lower.x);
	m[1] = 0.0f;
	m[2] = 0.0f;
	m[3] = 0.0f;

	m[4] = 0.0f;
	m[5] = 2.0f / (upper.y - lower.y);
	m[6] = 0.0f;
	m[7] = 0.0f;

	m[8] = 0.0f;
	m[9] = 0.0f;
	m[10] = 1.0f;
	m[11] = 0.0f;

	m[12] = -(upper.x + lower.x) / (upper.x - lower.x);
	m[13] = -(upper.y + lower.y) / (upper.y - lower.y);
	m[14] = zBias;
	m[15] = 1.0f;
	*/


}