summaryrefslogtreecommitdiffstats
path: root/servers/physics/step_sw.cpp
diff options
context:
space:
mode:
authorRémi Verschelde <rverschelde@gmail.com>2017-03-05 16:44:50 +0100
committerRémi Verschelde <rverschelde@gmail.com>2017-03-05 16:44:50 +0100
commit5dbf1809c6e3e905b94b8764e99491e608122261 (patch)
tree5e5a5360db15d86d59ec8c6e4f7eb511388c5a9a /servers/physics/step_sw.cpp
parent45438e9918d421b244bfd7776a30e67dc7f2d3e3 (diff)
downloadredot-engine-5dbf1809c6e3e905b94b8764e99491e608122261.tar.gz
A Whole New World (clang-format edition)
I can show you the code Pretty, with proper whitespace Tell me, coder, now when did You last write readable code? I can open your eyes Make you see your bad indent Force you to respect the style The core devs agreed upon A whole new world A new fantastic code format A de facto standard With some sugar Enforced with clang-format A whole new world A dazzling style we all dreamed of And when we read it through It's crystal clear That now we're in a whole new world of code
Diffstat (limited to 'servers/physics/step_sw.cpp')
-rw-r--r--servers/physics/step_sw.cpp201
1 files changed, 95 insertions, 106 deletions
diff --git a/servers/physics/step_sw.cpp b/servers/physics/step_sw.cpp
index 0bd5a874ea..c7b1be7a9b 100644
--- a/servers/physics/step_sw.cpp
+++ b/servers/physics/step_sw.cpp
@@ -31,279 +31,268 @@
#include "os/os.h"
-void StepSW::_populate_island(BodySW* p_body,BodySW** p_island,ConstraintSW **p_constraint_island) {
+void StepSW::_populate_island(BodySW *p_body, BodySW **p_island, ConstraintSW **p_constraint_island) {
p_body->set_island_step(_step);
p_body->set_island_next(*p_island);
- *p_island=p_body;
+ *p_island = p_body;
- for(Map<ConstraintSW*,int>::Element *E=p_body->get_constraint_map().front();E;E=E->next()) {
+ for (Map<ConstraintSW *, int>::Element *E = p_body->get_constraint_map().front(); E; E = E->next()) {
- ConstraintSW *c=(ConstraintSW*)E->key();
- if (c->get_island_step()==_step)
+ ConstraintSW *c = (ConstraintSW *)E->key();
+ if (c->get_island_step() == _step)
continue; //already processed
c->set_island_step(_step);
c->set_island_next(*p_constraint_island);
- *p_constraint_island=c;
+ *p_constraint_island = c;
-
- for(int i=0;i<c->get_body_count();i++) {
- if (i==E->get())
+ for (int i = 0; i < c->get_body_count(); i++) {
+ if (i == E->get())
continue;
BodySW *b = c->get_body_ptr()[i];
- if (b->get_island_step()==_step || b->get_mode()==PhysicsServer::BODY_MODE_STATIC || b->get_mode()==PhysicsServer::BODY_MODE_KINEMATIC)
+ if (b->get_island_step() == _step || b->get_mode() == PhysicsServer::BODY_MODE_STATIC || b->get_mode() == PhysicsServer::BODY_MODE_KINEMATIC)
continue; //no go
- _populate_island(c->get_body_ptr()[i],p_island,p_constraint_island);
+ _populate_island(c->get_body_ptr()[i], p_island, p_constraint_island);
}
}
}
-void StepSW::_setup_island(ConstraintSW *p_island,real_t p_delta) {
+void StepSW::_setup_island(ConstraintSW *p_island, real_t p_delta) {
- ConstraintSW *ci=p_island;
- while(ci) {
+ ConstraintSW *ci = p_island;
+ while (ci) {
bool process = ci->setup(p_delta);
//todo remove from island if process fails
- ci=ci->get_island_next();
+ ci = ci->get_island_next();
}
}
-void StepSW::_solve_island(ConstraintSW *p_island,int p_iterations,real_t p_delta){
+void StepSW::_solve_island(ConstraintSW *p_island, int p_iterations, real_t p_delta) {
- int at_priority=1;
+ int at_priority = 1;
- while(p_island) {
+ while (p_island) {
- for(int i=0;i<p_iterations;i++) {
+ for (int i = 0; i < p_iterations; i++) {
- ConstraintSW *ci=p_island;
- while(ci) {
+ ConstraintSW *ci = p_island;
+ while (ci) {
ci->solve(p_delta);
- ci=ci->get_island_next();
+ ci = ci->get_island_next();
}
}
at_priority++;
{
- ConstraintSW *ci=p_island;
- ConstraintSW *prev=NULL;
- while(ci) {
- if (ci->get_priority()<at_priority) {
+ ConstraintSW *ci = p_island;
+ ConstraintSW *prev = NULL;
+ while (ci) {
+ if (ci->get_priority() < at_priority) {
if (prev) {
prev->set_island_next(ci->get_island_next()); //remove
} else {
- p_island=ci->get_island_next();
+ p_island = ci->get_island_next();
}
} else {
- prev=ci;
+ prev = ci;
}
- ci=ci->get_island_next();
+ ci = ci->get_island_next();
}
}
}
-
}
-void StepSW::_check_suspend(BodySW *p_island,real_t p_delta) {
-
+void StepSW::_check_suspend(BodySW *p_island, real_t p_delta) {
- bool can_sleep=true;
+ bool can_sleep = true;
BodySW *b = p_island;
- while(b) {
+ while (b) {
- if (b->get_mode()==PhysicsServer::BODY_MODE_STATIC || b->get_mode()==PhysicsServer::BODY_MODE_KINEMATIC) {
- b=b->get_island_next();
+ if (b->get_mode() == PhysicsServer::BODY_MODE_STATIC || b->get_mode() == PhysicsServer::BODY_MODE_KINEMATIC) {
+ b = b->get_island_next();
continue; //ignore for static
}
if (!b->sleep_test(p_delta))
- can_sleep=false;
+ can_sleep = false;
- b=b->get_island_next();
+ b = b->get_island_next();
}
//put all to sleep or wake up everyoen
b = p_island;
- while(b) {
+ while (b) {
- if (b->get_mode()==PhysicsServer::BODY_MODE_STATIC || b->get_mode()==PhysicsServer::BODY_MODE_KINEMATIC) {
- b=b->get_island_next();
+ if (b->get_mode() == PhysicsServer::BODY_MODE_STATIC || b->get_mode() == PhysicsServer::BODY_MODE_KINEMATIC) {
+ b = b->get_island_next();
continue; //ignore for static
}
bool active = b->is_active();
- if (active==can_sleep)
+ if (active == can_sleep)
b->set_active(!can_sleep);
- b=b->get_island_next();
+ b = b->get_island_next();
}
}
-void StepSW::step(SpaceSW* p_space,real_t p_delta,int p_iterations) {
+void StepSW::step(SpaceSW *p_space, real_t p_delta, int p_iterations) {
p_space->lock(); // can't access space during this
p_space->setup(); //update inertias, etc
- const SelfList<BodySW>::List * body_list = &p_space->get_active_body_list();
+ const SelfList<BodySW>::List *body_list = &p_space->get_active_body_list();
/* INTEGRATE FORCES */
uint64_t profile_begtime = OS::get_singleton()->get_ticks_usec();
- uint64_t profile_endtime=0;
+ uint64_t profile_endtime = 0;
- int active_count=0;
+ int active_count = 0;
- const SelfList<BodySW>*b = body_list->first();
- while(b) {
+ const SelfList<BodySW> *b = body_list->first();
+ while (b) {
b->self()->integrate_forces(p_delta);
- b=b->next();
+ b = b->next();
active_count++;
}
p_space->set_active_objects(active_count);
-
{ //profile
- profile_endtime=OS::get_singleton()->get_ticks_usec();
- p_space->set_elapsed_time(SpaceSW::ELAPSED_TIME_INTEGRATE_FORCES,profile_endtime-profile_begtime);
- profile_begtime=profile_endtime;
+ profile_endtime = OS::get_singleton()->get_ticks_usec();
+ p_space->set_elapsed_time(SpaceSW::ELAPSED_TIME_INTEGRATE_FORCES, profile_endtime - profile_begtime);
+ profile_begtime = profile_endtime;
}
/* GENERATE CONSTRAINT ISLANDS */
- BodySW *island_list=NULL;
- ConstraintSW *constraint_island_list=NULL;
+ BodySW *island_list = NULL;
+ ConstraintSW *constraint_island_list = NULL;
b = body_list->first();
- int island_count=0;
+ int island_count = 0;
- while(b) {
+ while (b) {
BodySW *body = b->self();
+ if (body->get_island_step() != _step) {
- if (body->get_island_step()!=_step) {
-
- BodySW *island=NULL;
- ConstraintSW *constraint_island=NULL;
- _populate_island(body,&island,&constraint_island);
+ BodySW *island = NULL;
+ ConstraintSW *constraint_island = NULL;
+ _populate_island(body, &island, &constraint_island);
island->set_island_list_next(island_list);
- island_list=island;
+ island_list = island;
if (constraint_island) {
constraint_island->set_island_list_next(constraint_island_list);
- constraint_island_list=constraint_island;
+ constraint_island_list = constraint_island;
island_count++;
}
-
}
- b=b->next();
+ b = b->next();
}
p_space->set_island_count(island_count);
const SelfList<AreaSW>::List &aml = p_space->get_moved_area_list();
- while(aml.first()) {
- for(const Set<ConstraintSW*>::Element *E=aml.first()->self()->get_constraints().front();E;E=E->next()) {
+ while (aml.first()) {
+ for (const Set<ConstraintSW *>::Element *E = aml.first()->self()->get_constraints().front(); E; E = E->next()) {
- ConstraintSW*c=E->get();
- if (c->get_island_step()==_step)
+ ConstraintSW *c = E->get();
+ if (c->get_island_step() == _step)
continue;
c->set_island_step(_step);
c->set_island_next(NULL);
c->set_island_list_next(constraint_island_list);
- constraint_island_list=c;
+ constraint_island_list = c;
}
- p_space->area_remove_from_moved_list((SelfList<AreaSW>*)aml.first()); //faster to remove here
+ p_space->area_remove_from_moved_list((SelfList<AreaSW> *)aml.first()); //faster to remove here
}
{ //profile
- profile_endtime=OS::get_singleton()->get_ticks_usec();
- p_space->set_elapsed_time(SpaceSW::ELAPSED_TIME_GENERATE_ISLANDS,profile_endtime-profile_begtime);
- profile_begtime=profile_endtime;
+ profile_endtime = OS::get_singleton()->get_ticks_usec();
+ p_space->set_elapsed_time(SpaceSW::ELAPSED_TIME_GENERATE_ISLANDS, profile_endtime - profile_begtime);
+ profile_begtime = profile_endtime;
}
-
//print_line("island count: "+itos(island_count)+" active count: "+itos(active_count));
/* SETUP CONSTRAINT ISLANDS */
{
- ConstraintSW *ci=constraint_island_list;
- while(ci) {
+ ConstraintSW *ci = constraint_island_list;
+ while (ci) {
- _setup_island(ci,p_delta);
- ci=ci->get_island_list_next();
+ _setup_island(ci, p_delta);
+ ci = ci->get_island_list_next();
}
}
{ //profile
- profile_endtime=OS::get_singleton()->get_ticks_usec();
- p_space->set_elapsed_time(SpaceSW::ELAPSED_TIME_SETUP_CONSTRAINTS,profile_endtime-profile_begtime);
- profile_begtime=profile_endtime;
+ profile_endtime = OS::get_singleton()->get_ticks_usec();
+ p_space->set_elapsed_time(SpaceSW::ELAPSED_TIME_SETUP_CONSTRAINTS, profile_endtime - profile_begtime);
+ profile_begtime = profile_endtime;
}
/* SOLVE CONSTRAINT ISLANDS */
{
- ConstraintSW *ci=constraint_island_list;
- while(ci) {
+ ConstraintSW *ci = constraint_island_list;
+ while (ci) {
//iterating each island separatedly improves cache efficiency
- _solve_island(ci,p_iterations,p_delta);
- ci=ci->get_island_list_next();
+ _solve_island(ci, p_iterations, p_delta);
+ ci = ci->get_island_list_next();
}
}
-
{ //profile
- profile_endtime=OS::get_singleton()->get_ticks_usec();
- p_space->set_elapsed_time(SpaceSW::ELAPSED_TIME_SOLVE_CONSTRAINTS,profile_endtime-profile_begtime);
- profile_begtime=profile_endtime;
+ profile_endtime = OS::get_singleton()->get_ticks_usec();
+ p_space->set_elapsed_time(SpaceSW::ELAPSED_TIME_SOLVE_CONSTRAINTS, profile_endtime - profile_begtime);
+ profile_begtime = profile_endtime;
}
/* INTEGRATE VELOCITIES */
b = body_list->first();
- while(b) {
- const SelfList<BodySW>*n=b->next();
+ while (b) {
+ const SelfList<BodySW> *n = b->next();
b->self()->integrate_velocities(p_delta);
- b=n;
+ b = n;
}
/* SLEEP / WAKE UP ISLANDS */
{
- BodySW *bi=island_list;
- while(bi) {
+ BodySW *bi = island_list;
+ while (bi) {
- _check_suspend(bi,p_delta);
- bi=bi->get_island_list_next();
+ _check_suspend(bi, p_delta);
+ bi = bi->get_island_list_next();
}
}
{ //profile
- profile_endtime=OS::get_singleton()->get_ticks_usec();
- p_space->set_elapsed_time(SpaceSW::ELAPSED_TIME_INTEGRATE_VELOCITIES,profile_endtime-profile_begtime);
- profile_begtime=profile_endtime;
+ profile_endtime = OS::get_singleton()->get_ticks_usec();
+ p_space->set_elapsed_time(SpaceSW::ELAPSED_TIME_INTEGRATE_VELOCITIES, profile_endtime - profile_begtime);
+ profile_begtime = profile_endtime;
}
p_space->update();
p_space->unlock();
_step++;
-
-
-
}
StepSW::StepSW() {
- _step=1;
+ _step = 1;
}