123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252 |
- #include "collision_object_2d_sw.h"
- #include "space_2d_sw.h"
- void CollisionObject2DSW::add_shape(Shape2DSW *p_shape, const Transform2D &p_transform) {
- Shape s;
- s.shape = p_shape;
- s.xform = p_transform;
- s.xform_inv = s.xform.affine_inverse();
- s.bpid = 0;
- s.disabled = false;
- s.one_way_collision = false;
- shapes.push_back(s);
- p_shape->add_owner(this);
- _update_shapes();
- _shapes_changed();
- }
- void CollisionObject2DSW::set_shape(int p_index, Shape2DSW *p_shape) {
- ERR_FAIL_INDEX(p_index, shapes.size());
- shapes[p_index].shape->remove_owner(this);
- shapes.write[p_index].shape = p_shape;
- p_shape->add_owner(this);
- _update_shapes();
- _shapes_changed();
- }
- void CollisionObject2DSW::set_shape_metadata(int p_index, const Variant &p_metadata) {
- ERR_FAIL_INDEX(p_index, shapes.size());
- shapes.write[p_index].metadata = p_metadata;
- }
- void CollisionObject2DSW::set_shape_transform(int p_index, const Transform2D &p_transform) {
- ERR_FAIL_INDEX(p_index, shapes.size());
- shapes.write[p_index].xform = p_transform;
- shapes.write[p_index].xform_inv = p_transform.affine_inverse();
- _update_shapes();
- _shapes_changed();
- }
- void CollisionObject2DSW::set_shape_as_disabled(int p_idx, bool p_disabled) {
- ERR_FAIL_INDEX(p_idx, shapes.size());
- CollisionObject2DSW::Shape &shape = shapes.write[p_idx];
- if (shape.disabled == p_disabled)
- return;
- shape.disabled = p_disabled;
- if (!space)
- return;
- if (p_disabled && shape.bpid != 0) {
- space->get_broadphase()->remove(shape.bpid);
- shape.bpid = 0;
- _update_shapes();
- } else if (!p_disabled && shape.bpid == 0) {
- _update_shapes();
- }
- }
- void CollisionObject2DSW::remove_shape(Shape2DSW *p_shape) {
-
- for (int i = 0; i < shapes.size(); i++) {
- if (shapes[i].shape == p_shape) {
- remove_shape(i);
- i--;
- }
- }
- }
- void CollisionObject2DSW::remove_shape(int p_index) {
-
- ERR_FAIL_INDEX(p_index, shapes.size());
- for (int i = p_index; i < shapes.size(); i++) {
- if (shapes[i].bpid == 0)
- continue;
-
- space->get_broadphase()->remove(shapes[i].bpid);
- shapes.write[i].bpid = 0;
- }
- shapes[p_index].shape->remove_owner(this);
- shapes.remove(p_index);
- _update_shapes();
- _shapes_changed();
- }
- void CollisionObject2DSW::_set_static(bool p_static) {
- if (_static == p_static)
- return;
- _static = p_static;
- if (!space)
- return;
- for (int i = 0; i < get_shape_count(); i++) {
- const Shape &s = shapes[i];
- if (s.bpid > 0) {
- space->get_broadphase()->set_static(s.bpid, _static);
- }
- }
- }
- void CollisionObject2DSW::_unregister_shapes() {
- for (int i = 0; i < shapes.size(); i++) {
- Shape &s = shapes.write[i];
- if (s.bpid > 0) {
- space->get_broadphase()->remove(s.bpid);
- s.bpid = 0;
- }
- }
- }
- void CollisionObject2DSW::_update_shapes() {
- if (!space)
- return;
- for (int i = 0; i < shapes.size(); i++) {
- Shape &s = shapes.write[i];
- if (s.disabled)
- continue;
- if (s.bpid == 0) {
- s.bpid = space->get_broadphase()->create(this, i);
- space->get_broadphase()->set_static(s.bpid, _static);
- }
-
- Rect2 shape_aabb = s.shape->get_aabb();
- Transform2D xform = transform * s.xform;
- shape_aabb = xform.xform(shape_aabb);
- s.aabb_cache = shape_aabb;
- s.aabb_cache = s.aabb_cache.grow((s.aabb_cache.size.x + s.aabb_cache.size.y) * 0.5 * 0.05);
- space->get_broadphase()->move(s.bpid, s.aabb_cache);
- }
- }
- void CollisionObject2DSW::_update_shapes_with_motion(const Vector2 &p_motion) {
- if (!space)
- return;
- for (int i = 0; i < shapes.size(); i++) {
- Shape &s = shapes.write[i];
- if (s.disabled)
- continue;
- if (s.bpid == 0) {
- s.bpid = space->get_broadphase()->create(this, i);
- space->get_broadphase()->set_static(s.bpid, _static);
- }
-
- Rect2 shape_aabb = s.shape->get_aabb();
- Transform2D xform = transform * s.xform;
- shape_aabb = xform.xform(shape_aabb);
- shape_aabb = shape_aabb.merge(Rect2(shape_aabb.position + p_motion, shape_aabb.size));
- s.aabb_cache = shape_aabb;
- space->get_broadphase()->move(s.bpid, shape_aabb);
- }
- }
- void CollisionObject2DSW::_set_space(Space2DSW *p_space) {
- if (space) {
- space->remove_object(this);
- for (int i = 0; i < shapes.size(); i++) {
- Shape &s = shapes.write[i];
- if (s.bpid) {
- space->get_broadphase()->remove(s.bpid);
- s.bpid = 0;
- }
- }
- }
- space = p_space;
- if (space) {
- space->add_object(this);
- _update_shapes();
- }
- }
- void CollisionObject2DSW::_shape_changed() {
- _update_shapes();
- _shapes_changed();
- }
- CollisionObject2DSW::CollisionObject2DSW(Type p_type) {
- _static = true;
- type = p_type;
- space = NULL;
- instance_id = 0;
- canvas_instance_id = 0;
- collision_mask = 1;
- collision_layer = 1;
- pickable = true;
- }
|