[SFML 2.0] Kolizja (koncepcje)

#include <SFML/Graphics.hpp>
#include <iostream>

int main()
{
    srand( time( NULL ) );
   
    sf::RenderWindow window( sf::VideoMode( 640, 480 ), "gierka xD" );
    //window.setFramerateLimit(60);
    sf::Clock clock;
   
    // losowa mapa
    sf::RectangleShape rects[ 100 ];
   
    const float qqq = 150.0;
    for( int y = 0; y < 10; ++y ) {
        for( int x = 0; x < 10; ++x ) {
            float px = rand() %( int ) qqq * 10;
            float py = rand() %( int ) qqq * 10;
            rects[ x + y * 10 ].setSize( sf::Vector2f( qqq * 0.5, qqq * 0.5 ) );
            rects[ x + y * 10 ].setPosition( px, py );
            rects[ x + y * 10 ].setFillColor( sf::Color::Green );
        }
    }
   
    // gracz
    sf::CircleShape player( 5.0, 10 );
    player.setFillColor( sf::Color::Black );
    player.setOrigin( sf::Vector2f( player.getRadius(), player.getRadius() ) );
   
    // znajdz wolna pozycje dla gracza.Czasami niedziala;P
    while( 1 ) {
        bool found = false;
        sf::Vector2f pp( rand() %( int ) qqq * 10, rand() %( int ) qqq * 10 );
        player.setPosition( pp );
        for( int q = 0; q < 100; ++q ) {
            sf::RectangleShape rect = rects[ q ];
            sf::FloatRect rbound = rect.getGlobalBounds();
            if( rbound.intersects( player.getGlobalBounds() ) )
                 found = false;
            else
                 found = true;
           
        }
        if( found )
             break;
       
    }
   
    const float dstep = 1.0;
    float dirH, dirV;
   
    while( window.isOpen() )
    {
        sf::Event event;
        while( window.pollEvent( event ) )
        {
            if( event.type == sf::Event::Closed )
                 window.close();
           
        }
       
        dirV = dirH = 0.0;
        if( sf::Keyboard::isKeyPressed( sf::Keyboard::Right ) )
             dirH = dstep;
        else if( sf::Keyboard::isKeyPressed( sf::Keyboard::Left ) )
             dirH = - dstep;
       
        if( sf::Keyboard::isKeyPressed( sf::Keyboard::Up ) )
             dirV = - dstep;
        else if( sf::Keyboard::isKeyPressed( sf::Keyboard::Down ) )
             dirV = dstep;
       
       
        window.clear( sf::Color( 127, 127, 127, 0 ) );
       
        for( int q = 0; q < 100; ++q )
             window.draw( rects[ q ] );
       
        int t = clock.getElapsedTime().asMilliseconds();
        clock.restart();
       
        // stara pozycja gracza bedzie potrzebna pozniej
        sf::Vector2f lastpos( player.getPosition() );
       
        float distance =( 0.2 * t );
        // nowa pozycja dla gracza
        sf::Vector2f plpos( player.getPosition().x +( dirH * distance ), player.getPosition().y +( dirV * distance ) );
       
        //szukanie kolizji.Niedziała przy szybkim ruchu na nowa pozycje
        bool colx = false, coly = false;
        sf::Vector2f forx( plpos.x, lastpos.y ); // stara pozycja z nowym x
        sf::Vector2f fory( lastpos.x, plpos.y ); // stara pozycja z nowym y
        for( int q = 0; q < 100; ++q ) {
            sf::RectangleShape rect = rects[ q ];
            sf::FloatRect rbound = rect.getGlobalBounds();
           
            // try x
            player.setPosition( forx );
            if( rbound.intersects( player.getGlobalBounds() ) )
                 colx = true;
            // try  y
            player.setPosition( fory );
            if( rbound.intersects( player.getGlobalBounds() ) )
                 coly = true;
           
            // jesli na 100% nie bedzie kolidowac z wieloma przerwij
            //if(colx || coly)
            //    break;
           
            // jesli dla x i y jest kolizja niema sensu sprawdzac dalej
            if( colx && coly )
                 break;
           
        }
       
        sf::Vector2f newpos( lastpos );
        if( !colx )
             newpos.x = plpos.x;
       
        if( !coly )
             newpos.y = plpos.y;
       
        player.setPosition( newpos );
       
        sf::View view = window.getDefaultView();
        view.setCenter( player.getPosition() );
        window.setView( view );
       
        window.draw( player );
        window.display();
    }
    return 0;
}