/* * Copyright (c) 2006-2009 Erin Catto http://www.gphysics.com * * This software is provided 'as-is', without any express or implied * warranty. In no event will the authors be held liable for any damages * arising from the use of this software. * Permission is granted to anyone to use this software for any purpose, * including commercial applications, and to alter it and redistribute it * freely, subject to the following restrictions: * 1. The origin of this software must not be misrepresented; you must not * claim that you wrote the original software. If you use this software * in a product, an acknowledgment in the product documentation would be * appreciated but is not required. * 2. Altered source versions must be plainly marked as such, and must not be * misrepresented as being the original software. * 3. This notice may not be removed or altered from any source distribution. */ // Contributed by caspin. #ifndef CONTACT_CB_H #define CONTACT_CB_H #include <set> #include <deque> #include <sstream> #include <string> #include <iostream> bool key_comp( const ContactPoint& lhs, const ContactPoint& rhs ) { if( lhs.fixtureA < rhs.fixtureA ) return true; if( lhs.fixtureA == rhs.fixtureA && lhs.fixtureB < rhs.fixtureB ) return true; if( lhs.fixtureA == rhs.fixtureA && lhs.fixtureB == rhs.fixtureB && lhs.id.key < rhs.id.key ) return true; return false; } class ContactCB : public Test { public: ContactCB() : m_set(&key_comp) { b2PolygonDef sd; sd.friction = 0; sd.vertexCount = 3; sd.vertices[0].Set(10,10); sd.vertices[1].Set(9,7); sd.vertices[2].Set(10,0); m_world->GetGroundBody()->CreateFixture(&sd); sd.vertices[0].Set(9,7); sd.vertices[1].Set(8,0); sd.vertices[2].Set(10,0); m_world->GetGroundBody()->CreateFixture(&sd); sd.vertices[0].Set(9,7); sd.vertices[1].Set(8,5); sd.vertices[2].Set(8,0); m_world->GetGroundBody()->CreateFixture(&sd); sd.vertices[0].Set(8,5); sd.vertices[1].Set(7,4); sd.vertices[2].Set(8,0); m_world->GetGroundBody()->CreateFixture(&sd); sd.vertices[0].Set(7,4); sd.vertices[1].Set(5,0); sd.vertices[2].Set(8,0); m_world->GetGroundBody()->CreateFixture(&sd); sd.vertices[0].Set(7,4); sd.vertices[1].Set(5,3); sd.vertices[2].Set(5,0); m_world->GetGroundBody()->CreateFixture(&sd); sd.vertices[0].Set(5,3); sd.vertices[1].Set(2,2); sd.vertices[2].Set(5,0); m_world->GetGroundBody()->CreateFixture(&sd); sd.vertices[0].Set(2,2); sd.vertices[1].Set(0,0); sd.vertices[2].Set(5,0); m_world->GetGroundBody()->CreateFixture(&sd); sd.vertices[0].Set(2,2); sd.vertices[1].Set(-2,2); sd.vertices[2].Set(0,0); m_world->GetGroundBody()->CreateFixture(&sd); sd.vertices[2].Set(-2,2); sd.vertices[1].Set(0,0); sd.vertices[0].Set(-5,0); m_world->GetGroundBody()->CreateFixture(&sd); sd.vertices[2].Set(-5,3); sd.vertices[1].Set(-2,2); sd.vertices[0].Set(-5,0); m_world->GetGroundBody()->CreateFixture(&sd); sd.vertices[2].Set(-7,4); sd.vertices[1].Set(-5,3); sd.vertices[0].Set(-5,0); m_world->GetGroundBody()->CreateFixture(&sd); sd.vertices[2].Set(-7,4); sd.vertices[1].Set(-5,0); sd.vertices[0].Set(-8,0); m_world->GetGroundBody()->CreateFixture(&sd); sd.vertices[2].Set(-8,5); sd.vertices[1].Set(-7,4); sd.vertices[0].Set(-8,0); m_world->GetGroundBody()->CreateFixture(&sd); sd.vertices[2].Set(-9,7); sd.vertices[1].Set(-8,5); sd.vertices[0].Set(-8,0); m_world->GetGroundBody()->CreateFixture(&sd); sd.vertices[2].Set(-9,7); sd.vertices[1].Set(-8,0); sd.vertices[0].Set(-10,0); m_world->GetGroundBody()->CreateFixture(&sd); sd.vertices[2].Set(-10,10); sd.vertices[1].Set(-9,7); sd.vertices[0].Set(-10,0); m_world->GetGroundBody()->CreateFixture(&sd); sd.SetAsBox(.5,6,b2Vec2(10.5,6),0); m_world->GetGroundBody()->CreateFixture(&sd); sd.SetAsBox(.5,6,b2Vec2(-10.5,6),0); m_world->GetGroundBody()->CreateFixture(&sd); b2BodyDef bd; bd.position.Set(9.5,60); b2Body* m_ball = m_world->CreateBody( &bd ); #if 1 b2PolygonDef cd; cd.vertexCount = 8; float32 w = 0.95f; float32 b = w / (2.0f + sqrtf(2.0f)); float32 s = sqrtf(2.0f) * b; cd.vertices[0].Set(0.5f * s, 0.0f); cd.vertices[1].Set(0.5f * w, b); cd.vertices[2].Set(0.5f * w, b + s); cd.vertices[3].Set(0.5f * s, w); cd.vertices[4].Set(-0.5f * s, w); cd.vertices[5].Set(-0.5f * w, b + s); cd.vertices[6].Set(-0.5f * w, b); cd.vertices[7].Set(-0.5f * s, 0.0f); cd.density = 1.0f; #else b2CircleDef cd; cd.radius = 0.33f; cd.friction = 0; cd.density = 1; #endif m_ball_shape = m_ball->CreateFixture(&cd); m_ball->SetMassFromShapes(); } void Step(Settings* settings) { Test::Step(settings); std::ostringstream oss; oss << std::hex; for (int32 i=0; i< m_pointCount; ++i) { #if 0 if (m_points[i].shape1 > m_points[i].shape2) { b2Swap(m_points[i].shape1, m_points[i].shape2); m_points[i].normal *= -1.0f; m_points[i].velocity *= -1.0f; } #endif oss.str(""); switch( m_points[i].state ) { case e_contactAdded: { if( ! m_set.insert( m_points[i] ).second ) { oss << "ERROR "; } else { oss << " "; } oss << "added: " << m_points[i].fixtureA << " -> " << m_points[i].fixtureB; oss << " : " << m_points[i].id.key; m_strings.push_back( oss.str() ); std::cout << oss.str() << std::endl; break; } case e_contactRemoved: { if( m_set.find( m_points[i] ) == m_set.end() ) { oss << "ERROR "; } else { oss << " "; } oss << "removed: " << m_points[i].fixtureA << " -> " << m_points[i].fixtureB; oss << " : " << m_points[i].id.key; m_strings.push_back( oss.str() ); std::cout << oss.str() << std::endl; m_set.erase( m_points[i] ); break; } case e_contactPersisted: { if( m_set.find( m_points[i] ) == m_set.end() ) { oss << "ERROR persist: " << m_points[i].fixtureA << " -> "; oss << m_points[i].fixtureB << " : " << m_points[i].id.key; m_strings.push_back( oss.str() ); std::cout << oss.str() << std::endl; } break; } } } while( m_strings.size() > 15 ) { m_strings.pop_front(); } for( unsigned i=0; i<m_strings.size(); ++i ) { m_debugDraw.DrawString(5, m_textLine, m_strings[i].c_str() ); m_textLine += 15; } } static Test* Create() { return new ContactCB; } b2Body* m_ball; b2Body* m_bullet; b2Fixture* m_ball_shape; std::set<ContactPoint,bool(*)(const ContactPoint&,const ContactPoint&)> m_set; std::deque<std::string> m_strings; }; #endif // CONTACT_CB_H