BOOL CObjectSpace::_RayQuery2 (collide::rq_results& r_dest, const collide::ray_defs& R, collide::rq_callback* CB, LPVOID user_data, collide::test_callback* tb, CObject* ignore_object)
{
// initialize query
r_dest.r_clear ();
r_temp.r_clear ();
rq_target s_mask = rqtStatic;
rq_target d_mask = rq_target( ((R.tgt&rqtObject) ?rqtObject:rqtNone )|
((R.tgt&rqtObstacle)?rqtObstacle:rqtNone )|
((R.tgt&rqtShape) ?rqtShape:rqtNone) );
u32 d_flags = STYPE_COLLIDEABLE|((R.tgt&rqtObstacle)?STYPE_OBSTACLE:0)|((R.tgt&rqtShape)?STYPE_SHAPE:0);
// Test static
if (R.tgt&s_mask){
xrc.ray_options (R.flags);
xrc.ray_query (&Static,R.start,R.dir,R.range);
if (xrc.r_count()){
CDB::RESULT* _I = xrc.r_begin();
CDB::RESULT* _E = xrc.r_end ();
for (; _I!=_E; _I++)
r_temp.append_result(rq_result().set(0,_I->range,_I->id));
}
}
// Test dynamic
if (R.tgt&d_mask){
// Traverse object database
g_SpatialSpace->q_ray (r_spatial,0,d_flags,R.start,R.dir,R.range);
for (u32 o_it=0; o_it<r_spatial.size(); o_it++){
CObject* collidable = r_spatial[o_it]->dcast_CObject();
if (0==collidable) continue;
if (collidable==ignore_object) continue;
ICollisionForm* cform = collidable->collidable.model;
ECollisionFormType tp = collidable->collidable.model->Type();
if (((R.tgt&(rqtObject|rqtObstacle))&&(tp==cftObject))||((R.tgt&rqtShape)&&(tp==cftShape))){
if (tb&&!tb(R,collidable,user_data))continue;
cform->_RayQuery(R,r_temp);
}
}
}
if (r_temp.r_count()){
r_temp.r_sort ();
collide::rq_result* _I = r_temp.r_begin ();
collide::rq_result* _E = r_temp.r_end ();
for (; _I!=_E; _I++){
r_dest.append_result(*_I);
if (!(CB?CB(*_I,user_data):TRUE)) return r_dest.r_count();
if (R.flags&(CDB::OPT_ONLYNEAREST|CDB::OPT_ONLYFIRST)) return r_dest.r_count();
}
}
return r_dest.r_count();
}
bool CBulletManager::CalcBullet (collide::rq_results & rq_storage, xr_vector<ISpatial*>& rq_spatial, SBullet* bullet, u32 delta_time)
{
VERIFY (bullet);
float delta_time_sec = float(delta_time)/1000.f;
float range = bullet->speed*delta_time_sec;
float max_range = bullet->max_dist - bullet->fly_dist;
if(range>max_range)
range = max_range;
//запомнить текущую скорость пули, т.к. в
//RayQuery() она может поменяться из-за рикошетов
//и столкновений с объектами
Fvector cur_dir = bullet->dir;
bullet_test_callback_data bullet_data;
bullet_data.pBullet = bullet;
bullet_data.bStopTracing = true;
bullet->flags.ricochet_was = 0;
collide::ray_defs RD (bullet->pos, bullet->dir, range, CDB::OPT_CULL, collide::rqtBoth);
BOOL result = FALSE;
VERIFY (!fis_zero(RD.dir.square_magnitude()));
result = Level().ObjectSpace.RayQuery(rq_storage, RD, firetrace_callback, &bullet_data, test_callback, NULL);
if (result && bullet_data.bStopTracing)
{
range = (rq_storage.r_begin()+rq_storage.r_count()-1)->range;
}
range = _max (EPS_L,range);
bullet->flags.skipped_frame = (Device.dwFrame >= bullet->frame_num);
if(!bullet->flags.ricochet_was) {
//изменить положение пули
bullet->pos.mad(bullet->pos, cur_dir, range);
bullet->fly_dist += range;
if(bullet->fly_dist>=bullet->max_dist)
return false;
Fbox level_box = Level().ObjectSpace.GetBoundingVolume();
/* if(!level_box.contains(bullet->pos))
return false;
*/
if(!((bullet->pos.x>=level_box.x1) &&
(bullet->pos.x<=level_box.x2) &&
(bullet->pos.y>=level_box.y1) &&
// (bullet->pos.y<=level_box.y2) &&
(bullet->pos.z>=level_box.z1) &&
(bullet->pos.z<=level_box.z2)) )
return false;
//изменить скорость и направление ее полета
//с учетом гравитации
bullet->dir.mul(bullet->speed);
Fvector air_resistance = bullet->dir;
if (GameID() == GAME_SINGLE)
air_resistance.mul(-m_fAirResistanceK*delta_time_sec);
else
air_resistance.mul(-bullet->air_resistance*(bullet->speed)/(bullet->max_speed)*delta_time_sec);
/// Msg("Speed - %f; ar - %f, %f", bullet->dir.magnitude(), air_resistance.magnitude(), air_resistance.magnitude()/bullet->dir.magnitude()*100);
bullet->dir.add(air_resistance);
bullet->dir.y -= m_fGravityConst*delta_time_sec;
bullet->speed = bullet->dir.magnitude();
VERIFY(_valid(bullet->speed));
VERIFY(!fis_zero(bullet->speed));
// by Real Wolf 11.07.2014.
R_ASSERT(bullet->speed);
//вместо normalize(), чтоб не считать 2 раза magnitude()
bullet->dir.x /= bullet->speed;
bullet->dir.y /= bullet->speed;
bullet->dir.z /= bullet->speed;
}
if(bullet->speed<m_fMinBulletSpeed)
return false;
return true;
}
BOOL CObjectSpace::RayQuery (collide::rq_results& r_dest, ICollisionForm* target, const collide::ray_defs& R)
{
VERIFY (target);
r_dest.r_clear ();
return target->_RayQuery(R,r_dest);
}
BOOL CObjectSpace::_RayQuery (collide::rq_results& r_dest, const collide::ray_defs& R, collide::rq_callback* CB, LPVOID user_data, collide::test_callback* tb, CObject* ignore_object)
{
#ifdef DEBUG
if (R.range<EPS || !_valid(R.range))
Debug.fatal (DEBUG_INFO,"Invalid RayQuery range passed: %f.",R.range);
#endif
// initialize query
r_dest.r_clear ();
r_temp.r_clear ();
Flags32 sd_test; sd_test.assign (R.tgt);
rq_target next_test = R.tgt;
rq_result s_res;
ray_defs s_rd (R.start,R.dir,R.range,CDB::OPT_ONLYNEAREST|R.flags,R.tgt);
ray_defs d_rd (R.start,R.dir,R.range,CDB::OPT_ONLYNEAREST|R.flags,R.tgt);
rq_target s_mask = rqtStatic;
rq_target d_mask = rq_target( ((R.tgt&rqtObject) ?rqtObject:rqtNone )|
((R.tgt&rqtObstacle)?rqtObstacle:rqtNone )|
((R.tgt&rqtShape) ?rqtShape:rqtNone) );
u32 d_flags = STYPE_COLLIDEABLE|((R.tgt&rqtObstacle)?STYPE_OBSTACLE:0)|((R.tgt&rqtShape)?STYPE_SHAPE:0);
s_res.set (0,s_rd.range,-1);
do{
if ((R.tgt&s_mask)&&sd_test.is(s_mask)&&(next_test&s_mask)){
s_res.set (0,s_rd.range,-1);
// Test static model
if (s_rd.range>EPS){
xrc.ray_options (s_rd.flags);
xrc.ray_query (&Static,s_rd.start,s_rd.dir,s_rd.range);
if (xrc.r_count()){
if (s_res.set_if_less(xrc.r_begin())){
// set new static start & range
s_rd.range -= (s_res.range+EPS_L);
s_rd.start.mad (s_rd.dir,s_res.range+EPS_L);
s_res.range = R.range-s_rd.range-EPS_L;
#ifdef DEBUG
if (!(fis_zero(s_res.range,EPS) || s_res.range>=0.f))
Debug.fatal(DEBUG_INFO,"Invalid RayQuery static range: %f (%f). /#1/",s_res.range,s_rd.range);
#endif
}
}
}
if (!s_res.valid()) sd_test.set(s_mask,FALSE);
}
if ((R.tgt&d_mask)&&sd_test.is_any(d_mask)&&(next_test&d_mask)){
r_temp.r_clear ();
if (d_rd.range>EPS){
// Traverse object database
g_SpatialSpace->q_ray (r_spatial,0,d_flags,d_rd.start,d_rd.dir,d_rd.range);
// Determine visibility for dynamic part of scene
for (u32 o_it=0; o_it<r_spatial.size(); o_it++){
CObject* collidable = r_spatial[o_it]->dcast_CObject();
if (0==collidable) continue;
if (collidable==ignore_object) continue;
ICollisionForm* cform = collidable->collidable.model;
ECollisionFormType tp = collidable->collidable.model->Type();
if (((R.tgt&(rqtObject|rqtObstacle))&&(tp==cftObject))||((R.tgt&rqtShape)&&(tp==cftShape))){
if (tb&&!tb(d_rd,collidable,user_data))continue;
cform->_RayQuery(d_rd,r_temp);
}
#ifdef DEBUG
if (!((0==r_temp.r_count()) || (r_temp.r_count()&&(fis_zero(r_temp.r_begin()->range, EPS)||(r_temp.r_begin()->range>=0.f)))))
Debug.fatal(DEBUG_INFO,"Invalid RayQuery dynamic range: %f (%f). /#2/",r_temp.r_begin()->range,d_rd.range);
#endif
}
}
if (r_temp.r_count()){
// set new dynamic start & range
rq_result& d_res = *r_temp.r_begin();
d_rd.range -= (d_res.range+EPS_L);
d_rd.start.mad(d_rd.dir,d_res.range+EPS_L);
d_res.range = R.range-d_rd.range-EPS_L;
#ifdef DEBUG
if (!(fis_zero(d_res.range,EPS) || d_res.range>=0.f))
Debug.fatal(DEBUG_INFO,"Invalid RayQuery dynamic range: %f (%f). /#3/",d_res.range,d_rd.range);
#endif
}else{
sd_test.set(d_mask,FALSE);
}
}
if (s_res.valid()&&r_temp.r_count()){
// all test return result
if (s_res.range<r_temp.r_begin()->range){
// static nearer
BOOL need_calc = CB?CB(s_res,user_data):TRUE;
next_test = need_calc?s_mask:rqtNone;
r_dest.append_result (s_res);
}else{
// dynamic nearer
BOOL need_calc = CB?CB(*r_temp.r_begin(),user_data):TRUE;
next_test = need_calc?d_mask:rqtNone;
r_dest.append_result (*r_temp.r_begin());
}
}else if (s_res.valid()) {
// only static return result
BOOL need_calc = CB?CB(s_res,user_data):TRUE;
next_test = need_calc?s_mask:rqtNone;
r_dest.append_result (s_res);
}else if (r_temp.r_count()) {
// only dynamic return result
BOOL need_calc = CB?CB(*r_temp.r_begin(),user_data):TRUE;
next_test = need_calc?d_mask:rqtNone;
r_dest.append_result (*r_temp.r_begin());
}else{
// nothing selected
next_test = rqtNone;
}
if ((R.flags&CDB::OPT_ONLYFIRST)||(R.flags&CDB::OPT_ONLYNEAREST)) break;
} while (next_test!=rqtNone) ;
return r_dest.r_count () ;
}
BOOL CObjectSpace::_RayQuery3 (collide::rq_results& r_dest, const collide::ray_defs& R, collide::rq_callback* CB, LPVOID user_data, collide::test_callback* tb, CObject* ignore_object)
{
// initialize query
r_dest.r_clear ();
ray_defs d_rd (R);
ray_defs s_rd (R.start,R.dir,R.range,CDB::OPT_ONLYNEAREST|R.flags,R.tgt);
rq_target s_mask = rqtStatic;
rq_target d_mask = rq_target( ((R.tgt&rqtObject) ?rqtObject:rqtNone )|
((R.tgt&rqtObstacle)?rqtObstacle:rqtNone )|
((R.tgt&rqtShape) ?rqtShape:rqtNone) );
u32 d_flags = STYPE_COLLIDEABLE|((R.tgt&rqtObstacle)?STYPE_OBSTACLE:0)|((R.tgt&rqtShape)?STYPE_SHAPE:0);
float d_range = 0.f;
do{
r_temp.r_clear ();
if (R.tgt&s_mask){
// static test allowed
// test static
xrc.ray_options (s_rd.flags);
xrc.ray_query (&Static,s_rd.start,s_rd.dir,s_rd.range);
if (xrc.r_count()) {
VERIFY (xrc.r_count()==1);
rq_result s_res;
s_res.set (0,xrc.r_begin()->range,xrc.r_begin()->id);
// update dynamic test range
d_rd.range = s_res.range;
// set next static start & range
s_rd.range -= (s_res.range+EPS_L);
s_rd.start.mad (s_rd.dir,s_res.range+EPS_L);
s_res.range = R.range-s_rd.range-EPS_L;
r_temp.append_result(s_res);
}else{
d_rd.range = s_rd.range;
}
}
// test dynamic
if (R.tgt&d_mask) {
// Traverse object database
g_SpatialSpace->q_ray (r_spatial,0,d_flags,d_rd.start,d_rd.dir,d_rd.range);
for (u32 o_it=0; o_it<r_spatial.size(); o_it++){
CObject* collidable = r_spatial[o_it]->dcast_CObject();
if (0==collidable) continue;
if (collidable==ignore_object) continue;
ICollisionForm* cform = collidable->collidable.model;
ECollisionFormType tp = collidable->collidable.model->Type();
if (((R.tgt&(rqtObject|rqtObstacle))&&(tp==cftObject))||((R.tgt&rqtShape)&&(tp==cftShape))){
if (tb&&!tb(d_rd,collidable,user_data))continue;
u32 r_cnt = r_temp.r_count();
cform->_RayQuery (d_rd,r_temp);
for (int k=r_cnt; k<r_temp.r_count(); k++){
rq_result& d_res = *(r_temp.r_begin()+k);
d_res.range += d_range;
}
}
}
}
// set dynamic ray def
d_rd.start = s_rd.start;
d_range = R.range-s_rd.range;
if (r_temp.r_count()){
r_temp.r_sort ();
collide::rq_result* _I = r_temp.r_begin ();
collide::rq_result* _E = r_temp.r_end ();
for (; _I!=_E; _I++){
r_dest.append_result(*_I);
if (!(CB?CB(*_I,user_data):TRUE)) return r_dest.r_count();
if (R.flags&CDB::OPT_ONLYFIRST) return r_dest.r_count();
}
}
if ((R.flags&(CDB::OPT_ONLYNEAREST|CDB::OPT_ONLYFIRST)) && r_dest.r_count()) return r_dest.r_count();
}while(r_temp.r_count());
return r_dest.r_count() ;
}