libpsys: 0fe624ffcb4f src/psys.c

libpsys

view src/psys.c @ 4:0fe624ffcb4f

reorg

author	John Tsiombikas <nuclear@mutantstargoat.com>
date	Mon, 26 Sep 2011 18:25:18 +0300
parents	133094e2f5a5
children	613d2bf3ea1f

line source

1 #include <stdlib.h>

2 #include <math.h>

3 #include <assert.h>

4 #include <pthread.h>

5 #include <vmath.h>

6 #include "psys_impl.h"

8 static int spawn(struct psys_emitter *em, struct psys_particle *p, void *cls);

9 static void update_particle(struct psys_emitter *em, struct psys_particle *p, float tm, float dt, void *cls);

11 static int init_anm_track_vec3(struct anm_track_vec3 *v3t);

12 static void destroy_anm_track_vec3(struct anm_track_vec3 *v3t);

13 static void set_v3value(struct anm_track_vec3 *v3t, anm_time_t tm, vec3_t v);

14 static vec3_t get_v3value(struct anm_track_vec3 *v3t, anm_time_t tm);

16 static float random_val(float x, float range);

17 static vec3_t random_vec3(vec3_t v, vec3_t range);

19 /* particle pool */

20 static struct psys_particle *ppool;

21 static int ppool_size;

22 static pthread_mutex_t pool_lock = PTHREAD_MUTEX_INITIALIZER;

24 static struct psys_particle *palloc(void);

25 static void pfree(struct psys_particle *p);

27 /* --- constructors and shit --- */

29 struct psys_emitter *psys_create(void)

30 {

31 struct psys_emitter *em;

33 if(!(em = malloc(sizeof *em))) {

34 return 0;

35 }

36 if(psys_init(em) == -1) {

37 free(em);

38 return 0;

39 }

40 return em;

41 }

43 void psys_free(struct psys_emitter *em)

44 {

45 psys_destroy(em);

46 free(em);

47 }

49 int psys_init(struct psys_emitter *em)

50 {

51 memset(em, 0, sizeof *em);

53 if(anm_init_node(&em->prs) == -1)

54 goto err;

55 if(init_anm_track_vec3(&em->pos_range) == -1)

56 goto err;

57 if(anm_init_track(&em->rate) == -1)

58 goto err;

59 if(anm_init_track(&em->life) == -1)

60 goto err;

61 if(anm_init_track(&em->life_range) == -1)

62 goto err;

63 if(anm_init_track(&em->size) == -1)

64 goto err;

65 if(anm_init_track(&em->size_range) == -1)

66 goto err;

67 if(init_anm_track_vec3(&em->dir) == -1)

68 goto err;

69 if(init_anm_track_vec3(&em->dir_range) == -1)

70 goto err;

71 if(init_anm_track_vec3(&em->grav) == -1)

72 goto err;

74 em->spawn = spawn;

75 em->update = update_particle;

77 em->draw = psys_gl_draw;

78 em->draw_start = psys_gl_draw_start;

79 em->draw_end = psys_gl_draw_end;

81 return 0;

82 err:

83 psys_destroy(em);

84 return -1;

85 }

87 void psys_destroy(struct psys_emitter *em)

88 {

89 struct psys_particle *part;

91 part = em->plist;

92 while(part) {

93 struct psys_particle *tmp = part;

94 part = part->next;

95 pfree(tmp);

96 }

98 anm_destroy_node(&em->prs);

99 destroy_anm_track_vec3(&em->pos_range);

100 anm_destroy_track(&em->rate);

101 anm_destroy_track(&em->life);

102 anm_destroy_track(&em->size);

103 anm_destroy_track(&em->size_range);

104 destroy_anm_track_vec3(&em->dir);

105 destroy_anm_track_vec3(&em->dir_range);

106 destroy_anm_track_vec3(&em->grav);

107 }

108

109 void psys_set_texture(struct psys_emitter *em, unsigned int tex)

110 {

111 em->tex = tex;

112 }

113

114 void psys_set_pos(struct psys_emitter *em, vec3_t pos, vec3_t range, float tm)

115 {

116 anm_set_position(&em->prs, pos, ANM_SEC2TM(tm));

117 set_v3value(&em->pos_range, ANM_SEC2TM(tm), range);

118 }

119

120 void psys_set_rot(struct psys_emitter *em, quat_t rot, float tm)

121 {

122 anm_set_rotation(&em->prs, rot, ANM_SEC2TM(tm));

123 }

124

125 void psys_set_pivot(struct psys_emitter *em, vec3_t pivot)

126 {

127 anm_set_pivot(&em->prs, pivot);

128 }

129

130 void psys_set_rate(struct psys_emitter *em, float rate, float tm)

131 {

132 anm_set_value(&em->rate, ANM_SEC2TM(tm), rate);

133 }

134

135 void psys_set_life(struct psys_emitter *em, float life, float range, float tm)

136 {

137 anm_set_value(&em->life, ANM_SEC2TM(tm), life);

138 anm_set_value(&em->life_range, ANM_SEC2TM(tm), range);

139 }

140

141 void psys_set_size(struct psys_emitter *em, float size, float range, float tm)

142 {

143 anm_set_value(&em->size, ANM_SEC2TM(tm), size);

144 anm_set_value(&em->size_range, ANM_SEC2TM(tm), range);

145 }

146

147 void psys_set_dir(struct psys_emitter *em, vec3_t dir, vec3_t range, float tm)

148 {

149 set_v3value(&em->dir, ANM_SEC2TM(tm), dir);

150 set_v3value(&em->dir_range, ANM_SEC2TM(tm), range);

151 }

152

153 void psys_set_grav(struct psys_emitter *em, vec3_t grav, float tm)

154 {

155 set_v3value(&em->grav, ANM_SEC2TM(tm), grav);

156 }

157

158

159 void psys_clear_collision_planes(struct psys_emitter *em)

160 {

161 struct col_plane *plane;

162

163 plane = em->planes;

164 while(plane) {

165 struct col_plane *tmp = plane;

166 plane = plane->next;

167 free(tmp);

168 }

169 }

170

171 int psys_add_collision_plane(struct psys_emitter *em, plane_t plane, float elast)

172 {

173 struct col_plane *node;

174

175 if(!(node = malloc(sizeof *node))) {

176 return -1;

177 }

178 node->p = plane;

179 node->elasticity = elast;

180 node->next = em->planes;

181 em->planes = node;

182 return 0;

183 }

184

185 void psys_add_particle(struct psys_emitter *em, struct psys_particle *p)

186 {

187 p->next = em->plist;

188 em->plist = p;

189 }

190

191 void psys_spawn_func(struct psys_emitter *em, psys_spawn_func_t func, void *cls)

192 {

193 em->spawn = func;

194 em->spawn_cls = cls;

195 }

196

197 void psys_update_func(struct psys_emitter *em, psys_update_func_t func, void *cls)

198 {

199 em->update = func;

200 em->upd_cls = cls;

201 }

202

203 void psys_draw_func(struct psys_emitter *em, psys_draw_func_t draw,

204 psys_draw_start_func_t start, psys_draw_end_func_t end, void *cls)

205 {

206 em->draw = draw;

207 em->draw_start = start;

208 em->draw_end = end;

209 em->draw_cls = cls;

210 }

211

212 /* --- update and render --- */

213

214 void psys_update(struct psys_emitter *em, float tm)

215 {

216 float dt, spawn_dt, spawn_tm;

217 int i, spawn_count;

218 struct psys_particle *p, pdummy;

219 anm_time_t atm;

220

221 assert(em->spawn && em->update);

222

223 atm = ANM_SEC2TM(tm);

224

225 em->cur_rate = anm_get_value(&em->rate, atm);

226 dt = tm - em->last_update;

227

228 /* how many particles to spawn for this interval ? */

229 em->spawn_acc += em->cur_rate * dt;

230 if(em->spawn_acc >= 1.0) {

231 spawn_count = em->spawn_acc;

232 em->spawn_acc = fmod(em->spawn_acc, 1.0);

233 } else {

234 spawn_count = 0;

235 }

236

237 em->cur_dir = get_v3value(&em->dir, atm);

238 em->cur_life = anm_get_value(&em->life, atm);

239 em->cur_grav = get_v3value(&em->grav, atm);

240

241 spawn_dt = dt / (float)spawn_count;

242 spawn_tm = em->last_update;

243 for(i=0; i<spawn_count; i++) {

244 /* update emitter position for this spawning */

245 em->cur_pos = anm_get_position(&em->prs, ANM_SEC2TM(spawn_tm));

246

247 if(!(p = palloc())) {

248 return;

249 }

250 if(em->spawn(em, p, em->spawn_cls) == -1) {

251 pfree(p);

252 }

253 spawn_tm += spawn_dt;

254 }

255

256 /* update all particles */

257 p = em->plist;

258 while(p) {

259 em->update(em, p, tm, dt, em->upd_cls);

260 p = p->next;

261 }

262

263 /* cleanup dead particles */

264 pdummy.next = em->plist;

265 p = &pdummy;

266 while(p->next) {

267 if(p->next->life <= 0) {

268 struct psys_particle *tmp = p->next;

269 p->next = p->next->next;

270 pfree(tmp);

271 } else {

272 p = p->next;

273 }

274 }

275 em->plist = pdummy.next;

276

277 em->last_update = tm;

278 }

279

280 void psys_draw(struct psys_emitter *em)

281 {

282 struct psys_particle *p;

283

284 if(em->draw_start) {

285 em->draw_start(em, em->draw_cls);

286 }

287

288 p = em->plist;

289 while(p) {

290 em->draw(em, p, em->draw_cls);

291 p = p->next;

292 }

293

294 if(em->draw_end) {

295 em->draw_end(em, em->draw_cls);

296 }

297 }

298

299 static int spawn(struct psys_emitter *em, struct psys_particle *p, void *cls)

300 {

301 p->pos = random_vec3(em->cur_pos, em->cur_pos_range);

302 p->vel = random_vec3(em->cur_dir, em->dir_range);

303 p->size = random_val(em->cur_size, em->cur_size_range);

304 p->life = em->cur_life;

305

306 psys_add_particle(em, p);

307 return 0;

308 }

309

310 static void update_particle(struct psys_emitter *em, struct psys_particle *p, float tm, float dt, void *cls)

311 {

312 vec3_t accel;

313

314 accel.x = em->cur_grav.x - p->vel.x * em->drag;

315 accel.y = em->cur_grav.y - p->vel.y * em->drag;

316 accel.z = em->cur_grav.z - p->vel.z * em->drag;

317

318 p->vel.x += accel.x * dt;

319 p->vel.y += accel.y * dt;

320 p->vel.z += accel.z * dt;

321

322 p->pos.x += p->vel.x * dt;

323 p->pos.y += p->vel.y * dt;

324 p->pos.z += p->vel.z * dt;

325

326 p->life -= dt;

327 }

328

329 /* --- anm_track_vec3 helper --- */

330

331 int init_anm_track_vec3(struct anm_track_vec3 *v3t)

332 {

333 if(anm_init_track(&v3t->x) == -1) {

334 return -1;

335 }

336 if(anm_init_track(&v3t->y) == -1) {

337 anm_destroy_track(&v3t->x);

338 return -1;

339 }

340 if(anm_init_track(&v3t->z) == -1) {

341 anm_destroy_track(&v3t->x);

342 anm_destroy_track(&v3t->y);

343 return -1;

344 }

345 return 0;

346 }

347

348 static void destroy_anm_track_vec3(struct anm_track_vec3 *v3t)

349 {

350 anm_destroy_track(&v3t->x);

351 anm_destroy_track(&v3t->y);

352 anm_destroy_track(&v3t->z);

353 }

354

355 static void set_v3value(struct anm_track_vec3 *v3t, anm_time_t tm, vec3_t v)

356 {

357 anm_set_value(&v3t->x, tm, v.x);

358 anm_set_value(&v3t->y, tm, v.y);

359 anm_set_value(&v3t->z, tm, v.z);

360 }

361

362 static vec3_t get_v3value(struct anm_track_vec3 *v3t, anm_time_t tm)

363 {

364 vec3_t v;

365 v.x = anm_get_value(&v3t->x, tm);

366 v.y = anm_get_value(&v3t->y, tm);

367 v.z = anm_get_value(&v3t->z, tm);

368 return v;

369 }

370

371 /* --- particle allocation pool --- */

372

373 static struct psys_particle *palloc(void)

374 {

375 struct psys_particle *p;

376

377 pthread_mutex_lock(&pool_lock);

378 if(ppool) {

379 p = ppool;

380 ppool = ppool->next;

381 ppool_size--;

382 } else {

383 p = malloc(sizeof *p);

384 }

385 pthread_mutex_unlock(&pool_lock);

386

387 if(p) {

388 memset(p, 0, sizeof *p);

389 /*reset_pattr(&p->attr);*/

390 }

391 return p;

392 }

393

394 static void pfree(struct psys_particle *p)

395 {

396 pthread_mutex_lock(&pool_lock);

397 p->next = ppool;

398 ppool = p;

399 ppool_size++;

400 pthread_mutex_unlock(&pool_lock);

401 }

402

403 static float random_val(float x, float range)

404 {

405 return x + range * (float)rand() / (float)RAND_MAX - 0.5 * range;

406 }

407

408 static vec3_t random_vec3(vec3_t v, vec3_t range)

409 {

410 vec3_t res;

411 res.x = random_val(v.x, range.x);

412 res.y = random_val(v.y, range.y);

413 res.z = random_val(v.z, range.z);

414 return res;

415 }