static void display_func(void) {
pre_display();
draw_forces();
draw_constraints();
draw_particles();
post_display();
}
static void display_func(void) {
pre_display();
if (dvel) draw_velocity();
else draw_density();
if (dpar) {
draw_forces();
draw_constraints();
draw_particles();
}
for(int i = 0; i < bodies.size(); i++){
bodies[i]->draw();
}
post_display();
}
static void
draw_shape(cpShape* shape, SDL_Surface* screen)
{
cpBody* body = shape->body;
struct draw_options opts = {
.surface = screen,
.colour = colour(200, 200, 200)
};
switch (shape->CP_PRIVATE(klass)->type)
{
case CP_CIRCLE_SHAPE:
draw_circle_shape(opts, shape, body);
break;
case CP_SEGMENT_SHAPE:
draw_segment_shape(opts, shape, body);
break;
case CP_POLY_SHAPE:
draw_poly_shape(opts, shape, body);
break;
default:
debug_putsf("ignoring unrecognised shape type %d",
shape->CP_PRIVATE(klass)->type);
break;
}
}
static void
draw_constraint(cpConstraint* constraint, SDL_Surface *screen)
{
struct draw_options opts = {
.surface = screen,
.colour = colour(100, 100, 200)
};
cpVect vect_a = cpBodyGetPos(cpConstraintGetA(constraint));
cpVect vect_b = cpBodyGetPos(cpConstraintGetB(constraint));
draw_line(opts, vect_a, vect_b);
}
static void
draw_rotation_vector(cpBody *body, SDL_Surface *screen)
{
struct draw_options opts = {
.surface = screen,
.colour = colour(200, 100, 100)
};
cpFloat rotation_vector_length = 30;
cpVect pos = cpBodyGetPos(body);
cpVect rotation = cpvmult(cpvforangle(cpBodyGetAngle(body)),
rotation_vector_length);
draw_line(opts, pos, cpvadd(pos, rotation));
}
static void
draw_forces(cpBody *body, SDL_Surface *screen)
{
struct draw_options opts = {
.surface = screen,
.colour = colour(100, 200, 100)
};
cpVect pos = cpBodyGetPos(body);
cpVect force = cpBodyGetForce(body);
draw_line(opts, pos, cpvadd(pos, force));
}
static void
draw_body(cpBody *body, SDL_Surface *screen)
{
draw_rotation_vector(body, screen);
draw_forces(body, screen);
}
void
debug_draw_space(cpSpace* space, SDL_Surface* screen)
{
cpSpaceEachShape(space,
(cpSpaceShapeIteratorFunc)draw_shape,
screen);
cpSpaceEachConstraint(space,
(cpSpaceConstraintIteratorFunc)draw_constraint,
screen);
cpSpaceEachBody(space,
(cpSpaceBodyIteratorFunc)draw_body,
screen);
}
