|
753
|
1 #include <iostream>
|
|
|
2 #include <math.h>
|
|
|
3 #include "SceneGraphRoot.h"
|
|
|
4 #include "SceneGraph.h"
|
|
|
5 #include "TaskManager.h"
|
|
|
6 #include "property_test.h"
|
|
|
7 #include "Func.h"
|
|
|
8
|
|
|
9 ChainPropertyPtr properties[2];
|
|
|
10 ChainProperty cv[CHAIN_LEN];
|
|
|
11
|
|
|
12
|
|
|
13 void createSceneGraphFromProperty(SceneGraphPtr root, ChainPropertyPtr cv, Viewer *sgroot);
|
|
|
14
|
|
|
15 void
|
|
|
16 init_chainold_vars(ChainPropertyPtr cv) {
|
|
|
17 cv->x = 0, cv->y = 0, cv->next_x = 0, cv->next_y = 0;
|
|
|
18 cv->vx = 0, cv->vy = 0, cv->next_vx = 0, cv->next_vy = 0;
|
|
|
19 cv->can_move = TRUE;
|
|
|
20 }
|
|
|
21
|
|
|
22 void
|
|
|
23 set_old_vector(ChainPropertyPtr cv, SceneGraphPtr sg) {
|
|
|
24 sg->xyz[0] = (float)cv->next_x;
|
|
|
25 sg->xyz[1] = (float)cv->next_y;
|
|
|
26 sg->xyz[2] = 0.0f;
|
|
|
27 }
|
|
|
28
|
|
|
29
|
|
|
30 static void
|
|
|
31 chain_old_move_ope(SceneGraphPtr node, void *sgroot_, int screen_w, int screen_h)
|
|
|
32 {
|
|
|
33 SceneGraphRoot *sgroot = (SceneGraphRoot *)sgroot_;
|
|
|
34 Pad *pad = sgroot->getController();
|
|
|
35
|
|
|
36 if (pad->cross.isHold()) {
|
|
|
37 cv[CHAIN_LEN-1].can_move = FALSE;
|
|
|
38 if (pad->left.isHold()) {
|
|
|
39 cv[CHAIN_LEN-1].x += -5.0;
|
|
|
40 } else if (pad->right.isHold()) {
|
|
|
41 cv[CHAIN_LEN-1].x += 5.0;
|
|
|
42 }
|
|
|
43
|
|
|
44 if (pad->up.isHold()) {
|
|
|
45 cv[CHAIN_LEN-1].y += -5.0;
|
|
|
46 } else if (pad->down.isHold()) {
|
|
|
47 cv[CHAIN_LEN-1].y += 5.0;
|
|
|
48 }
|
|
|
49 } else {
|
|
|
50 cv[CHAIN_LEN-1].can_move = TRUE;
|
|
|
51 }
|
|
|
52 }
|
|
|
53
|
|
|
54 void
|
|
|
55 chain_old_move(SceneGraphPtr sg, void *sgroot_, int w, int h)
|
|
|
56 {
|
|
|
57 int id = sg->id;
|
|
|
58 if(id == 0) {
|
|
|
59 for(int cnt = 0; cnt < 600; cnt++) {
|
|
|
60 for(int i = 0; i < CHAIN_LEN; i++) {
|
|
|
61 if(cv[i].can_move) {
|
|
|
62 double dx = cv[i-1].x - cv[i].x;
|
|
|
63 double dy = cv[i-1].y - cv[i].y;
|
|
|
64 double l = sqrt(dx * dx + dy * dy);
|
|
|
65 double a = k * (l - chain_width) / m;
|
|
|
66 double ax = a * dx / l;
|
|
|
67 double ay = a * dy / l;
|
|
|
68 if(i < CHAIN_LEN - 1) {
|
|
|
69 dx = cv[i+1].x - cv[i].x;
|
|
|
70 dy = cv[i+1].y - cv[i].y;
|
|
|
71 l = sqrt(dx * dx + dy * dy);
|
|
|
72 a = k * (l - chain_width) / m;
|
|
|
73 ax += a * dx / l;
|
|
|
74 ay += a * dy / l;
|
|
|
75 }
|
|
|
76 ay += g;
|
|
|
77 cv[i].vx *= safe;
|
|
|
78 cv[i].vy *= safe;
|
|
|
79 cv[i].next_vx = cv[i].vx + ax * dt;
|
|
|
80 cv[i].next_vy = cv[i].vy + ay * dt;
|
|
|
81 cv[i].next_x = cv[i].x + cv[i].vx * dt;
|
|
|
82 cv[i].next_y = cv[i].y + cv[i].vy * dt;
|
|
|
83 } else {
|
|
|
84 cv[i].next_x = cv[i].x;
|
|
|
85 cv[i].next_y = cv[i].y;
|
|
|
86 }
|
|
|
87 }
|
|
|
88 for(int i = 0; i < CHAIN_LEN; i++) {
|
|
|
89 cv[i].vx = cv[i].next_vx;
|
|
|
90 cv[i].vy = cv[i].next_vy;
|
|
|
91 cv[i].x = cv[i].next_x;
|
|
|
92 cv[i].y = cv[i].next_y;
|
|
|
93 }
|
|
|
94 }
|
|
|
95 // cout << id << ", " << sg->xyz[1] << endl;
|
|
|
96 }
|
|
|
97 set_old_vector(&cv[id], sg);
|
|
|
98 int p, n;
|
|
|
99 p = n = id;
|
|
|
100 if(p != 0) {
|
|
|
101 p--;
|
|
|
102 }
|
|
|
103 if(n != CHAIN_LEN - 1) {
|
|
|
104 n++;
|
|
|
105 }
|
|
|
106 sg->angle[2-(id%2)*2]
|
|
|
107 = 90 + atan((cv[p].next_y - cv[n].next_y) / (cv[p].next_x - cv[n].next_x)) * 180 / M_PI;
|
|
|
108 }
|
|
|
109
|
|
|
110 /*
|
|
|
111 void
|
|
|
112 chain_old_collision(SceneGraphPtr sg, int w, int h, SceneGraphPtr osg)
|
|
|
113 {
|
|
|
114
|
|
|
115 }
|
|
|
116 */
|
|
|
117
|
|
|
118 void
|
|
|
119 spe_move_collision(ChainProperty cv, void *sgroot_,spe_move_func new_move, spe_move_func new_collision)
|
|
|
120 {
|
|
|
121
|
|
|
122 cv.move = new_move;
|
|
|
123 cv.collision = new_collision;
|
|
|
124
|
|
|
125 }
|
|
|
126
|
|
|
127
|
|
|
128 void
|
|
|
129 chain_old_collision(SceneGraphPtr node, void *sgroot_, int w, int h, SceneGraphPtr ocv)
|
|
|
130 {
|
|
|
131 //createSceneGraphFromProperty(cv, cv);
|
|
|
132 }
|
|
|
133
|
|
|
134
|
|
|
135 void
|
|
|
136 property_swich()
|
|
|
137 {
|
|
|
138
|
|
|
139 }
|
|
|
140
|
|
|
141
|
|
|
142 void
|
|
|
143 createSceneGraphFromProperty(SceneGraphPtr root, ChainPropertyPtr cv, Viewer *sgroot)
|
|
|
144 {
|
|
|
145 SceneGraphPtr node;
|
|
|
146
|
|
|
147 for(int i = 0; i < CHAIN_LEN; i++) {
|
|
|
148 node = sgroot->createSceneGraph(cv[i].objname);
|
|
|
149 /**
|
|
|
150 * move, collision は spe で実行される, task taskID を持たせればよい
|
|
|
151 * property が 対応する taskID を持つので set_move_collision() は不要
|
|
|
152 * set_task_propety(move_taskID, collision_taskID) のようなものを作る
|
|
|
153 */
|
|
|
154 node->set_move_collision(chain_old_move, chain_old_collision);
|
|
|
155 //spe_move_collision(cv[i], chain_old_move, chain_old_collision);
|
|
|
156 node->id = cv[i].id;
|
|
|
157 node->angle[1] = cv[i].angle[1];
|
|
|
158 set_old_vector(&cv[i], node);
|
|
|
159 cv[i].parent->addChild(node);
|
|
|
160 }
|
|
|
161 sgroot->setSceneData(root);
|
|
|
162 }
|
|
|
163
|
|
|
164
|
|
|
165 void
|
|
|
166 set_properties(ChainPropertyPtr cv)
|
|
|
167 {
|
|
|
168 properties[0] = cv;
|
|
|
169 properties[1] = cv;
|
|
|
170 }
|
|
|
171
|
|
|
172 MainLoopPtr
|
|
|
173 Chain::init(Viewer *sgroot, int w, int h)
|
|
|
174 {
|
|
|
175 SceneGraphPtr root, chain;
|
|
|
176 sgroot->createFromXMLfile("xml_file/chain.xml");
|
|
|
177
|
|
|
178 ChainProperty rcv;
|
|
|
179 init_chainold_vars(&rcv);
|
|
|
180 rcv.next_x = w / 2;
|
|
|
181 rcv.next_y = 0.0;
|
|
|
182 rcv.id = CHAIN_LEN;
|
|
|
183
|
|
|
184 root = sgroot->createSceneGraph("CHAIN");
|
|
|
185 root->set_move_collision(chain_old_move_ope, chain_old_collision);
|
|
|
186 set_old_vector(&rcv, root);
|
|
|
187
|
|
|
188 chain = sgroot->createSceneGraph("CHAIN");
|
|
|
189 chain->set_move_collision(chain_old_move, chain_old_collision);
|
|
|
190
|
|
|
191 set_properties(cv);
|
|
|
192
|
|
|
193 for(int i = 0; i < CHAIN_LEN; i++) {
|
|
|
194 init_chainold_vars(&cv[i]);
|
|
|
195 cv[i].x = 0;
|
|
|
196 cv[i].y = chain_width * i;
|
|
|
197 cv[i].angle[1] = -90 * (i % 2);
|
|
|
198
|
|
|
199 chain->id = cv[i].id;
|
|
|
200 chain->angle[1] = cv[i].angle[1];
|
|
|
201 set_old_vector(&cv[i], chain);
|
|
|
202
|
|
|
203 cv[i].root = root;
|
|
|
204 cv[i].objname = "CHAIN";
|
|
|
205 cv[i].id = i;
|
|
|
206
|
|
|
207 cv[i].parent = root;
|
|
|
208
|
|
|
209 }
|
|
|
210
|
|
|
211 createSceneGraphFromProperty(root, cv, sgroot);
|
|
|
212 cv[0].can_move = FALSE;
|
|
|
213 //sgroot->setSceneData(root);
|
|
|
214
|
|
|
215 return sgroot;
|
|
|
216 }
|
|
|
217
|
|
|
218 extern Application *
|
|
|
219 application() {
|
|
|
220 return new Chain();
|
|
|
221 }
|
|
|
222
|
|
|
223 const char *usr_help_str = "Usage: ./test_nogl [OPTION]\n";
|
|
|
224
|
|
|
225 extern int init(TaskManager *manager, int argc, char *argv[]);
|
|
|
226 extern void task_initialize();
|
|
|
227 static void TMend(TaskManager *manager);
|
|
|
228
|
|
|
229 int
|
|
|
230 TMmain(TaskManager *manager, int argc, char *argv[])
|
|
|
231 {
|
|
|
232 task_initialize();
|
|
|
233 manager->set_TMend(TMend);
|
|
|
234 return init(manager, argc, argv);
|
|
|
235
|
|
|
236 }
|
|
|
237
|
|
|
238 void
|
|
|
239 TMend(TaskManager *manager)
|
|
|
240 {
|
|
|
241 printf("test_nogl end\n");
|
|
|
242 }
|
|
|
243
|
|
|
244 /* end */
|
|
|
245
|
