// -----------------------------------------------------------------------------------------------------------
// add rotational velocity & acceleration
void do_physics_sim_rot(object *obj)
{
vms_angvec tangles;
vms_matrix rotmat,new_orient;
//fix rotdrag_scale;
physics_info *pi;
Assert(FrameTime > 0); //Get MATT if hit this!
pi = &obj->mtype.phys_info;
if (!(pi->rotvel.x || pi->rotvel.y || pi->rotvel.z || pi->rotthrust.x || pi->rotthrust.y || pi->rotthrust.z))
return;
if (obj->mtype.phys_info.drag) {
int count;
vms_vector accel;
fix drag,r,k;
count = FrameTime / FT;
r = FrameTime % FT;
k = fixdiv(r,FT);
drag = (obj->mtype.phys_info.drag*5)/2;
if (obj->mtype.phys_info.flags & PF_USES_THRUST) {
vm_vec_copy_scale(&accel,&obj->mtype.phys_info.rotthrust,fixdiv(f1_0,obj->mtype.phys_info.mass));
while (count--) {
vm_vec_add2(&obj->mtype.phys_info.rotvel,&accel);
vm_vec_scale(&obj->mtype.phys_info.rotvel,f1_0-drag);
}
//do linear scale on remaining bit of time
vm_vec_scale_add2(&obj->mtype.phys_info.rotvel,&accel,k);
vm_vec_scale(&obj->mtype.phys_info.rotvel,f1_0-fixmul(k,drag));
}
else {
fix total_drag=f1_0;
while (count--)
total_drag = fixmul(total_drag,f1_0-drag);
//do linear scale on remaining bit of time
total_drag = fixmul(total_drag,f1_0-fixmul(k,drag));
vm_vec_scale(&obj->mtype.phys_info.rotvel,total_drag);
}
}
//now rotate object
//unrotate object for bank caused by turn
if (obj->mtype.phys_info.turnroll) {
vms_matrix new_pm;
tangles.p = tangles.h = 0;
tangles.b = -obj->mtype.phys_info.turnroll;
vm_angles_2_matrix(&rotmat,&tangles);
vm_matrix_x_matrix(&new_pm,&obj->orient,&rotmat);
obj->orient = new_pm;
}
tangles.p = fixmul(obj->mtype.phys_info.rotvel.x,FrameTime);
tangles.h = fixmul(obj->mtype.phys_info.rotvel.y,FrameTime);
tangles.b = fixmul(obj->mtype.phys_info.rotvel.z,FrameTime);
vm_angles_2_matrix(&rotmat,&tangles);
vm_matrix_x_matrix(&new_orient,&obj->orient,&rotmat);
obj->orient = new_orient;
if (obj->mtype.phys_info.flags & PF_TURNROLL)
set_object_turnroll(obj);
//re-rotate object for bank caused by turn
if (obj->mtype.phys_info.turnroll) {
vms_matrix new_pm;
tangles.p = tangles.h = 0;
tangles.b = obj->mtype.phys_info.turnroll;
vm_angles_2_matrix(&rotmat,&tangles);
vm_matrix_x_matrix(&new_pm,&obj->orient,&rotmat);
obj->orient = new_pm;
}
check_and_fix_matrix(&obj->orient);
}
void verify_object( object * obj ) {
obj->lifeleft = IMMORTAL_TIME; //all loaded object are immortal, for now
if ( obj->type == OBJ_ROBOT ) {
Gamesave_num_org_robots++;
// Make sure valid id...
if ( obj->id >= N_robot_types )
obj->id = obj->id % N_robot_types;
// Make sure model number & size are correct...
if ( obj->render_type == RT_POLYOBJ ) {
obj->rtype.pobj_info.model_num = Robot_info[obj->id].model_num;
obj->size = Polygon_models[obj->rtype.pobj_info.model_num].rad;
//@@if (obj->control_type==CT_AI && Robot_info[obj->id].attack_type)
//@@ obj->size = obj->size*3/4;
}
if (obj->movement_type == MT_PHYSICS) {
obj->mtype.phys_info.mass = Robot_info[obj->id].mass;
obj->mtype.phys_info.drag = Robot_info[obj->id].drag;
}
}
else { //Robots taken care of above
if ( obj->render_type == RT_POLYOBJ ) {
int i;
char *name = Save_pof_names[obj->rtype.pobj_info.model_num];
for (i=0;i<N_polygon_models;i++)
if (!d_stricmp(Pof_names[i],name)) { //found it!
obj->rtype.pobj_info.model_num = i;
break;
}
}
}
if ( obj->type == OBJ_POWERUP ) {
if ( obj->id >= N_powerup_types ) {
obj->id = 0;
Assert( obj->render_type != RT_POLYOBJ );
}
obj->control_type = CT_POWERUP;
obj->size = Powerup_info[obj->id].size;
if (Game_mode & GM_NETWORK)
{
if (multi_powerup_is_4pack(obj->id))
{
PowerupsInMine[obj->id-1]+=4;
MaxPowerupsAllowed[obj->id-1]+=4;
}
else
{
PowerupsInMine[obj->id]++;
MaxPowerupsAllowed[obj->id]++;
}
}
}
if ( obj->type == OBJ_WEAPON ) {
if ( obj->id >= N_weapon_types ) {
obj->id = 0;
Assert( obj->render_type != RT_POLYOBJ );
}
}
if ( obj->type == OBJ_CNTRLCEN ) {
int i;
obj->render_type = RT_POLYOBJ;
obj->control_type = CT_CNTRLCEN;
// Make model number is correct...
for (i=0; i<Num_total_object_types; i++ )
if ( ObjType[i] == OL_CONTROL_CENTER ) {
obj->rtype.pobj_info.model_num = ObjId[i];
obj->shields = ObjStrength[i];
break;
}
}
if ( obj->type == OBJ_PLAYER ) {
//int i;
//Assert(obj == Player);
if ( obj == ConsoleObject )
init_player_object();
else
if (obj->render_type == RT_POLYOBJ) //recover from Matt's pof file matchup bug
obj->rtype.pobj_info.model_num = Player_ship->model_num;
//Make sure orient matrix is orthogonal
check_and_fix_matrix(&obj->orient);
obj->id = Gamesave_num_players++;
}
if (obj->type == OBJ_HOSTAGE) {
if (obj->id > N_hostage_types)
obj->id = 0;
obj->render_type = RT_HOSTAGE;
obj->control_type = CT_POWERUP;
}
}
int automap_process_input(window *wind, d_event *event, automap *am)
{
vms_matrix tempm;
Controls = am->controls;
kconfig_read_controls(event, 1);
am->controls = Controls;
memset(&Controls, 0, sizeof(control_info));
if ( !am->controls.automap_state && (am->leave_mode==1) )
{
window_close(wind);
return 1;
}
if ( am->controls.automap_count > 0)
{
am->controls.automap_count = 0;
if (am->leave_mode==0)
{
window_close(wind);
return 1;
}
}
if (PlayerCfg.AutomapFreeFlight)
{
if ( am->controls.fire_primary_count > 0)
{
// Reset orientation
am->viewMatrix = Objects[Players[Player_num].objnum].orient;
vm_vec_scale_add(&am->view_position, &Objects[Players[Player_num].objnum].pos, &am->viewMatrix.fvec, -ZOOM_DEFAULT );
am->controls.fire_primary_count = 0;
}
if (am->controls.pitch_time || am->controls.heading_time || am->controls.bank_time)
{
vms_angvec tangles;
vms_matrix new_m;
tangles.p = fixdiv( am->controls.pitch_time, ROT_SPEED_DIVISOR );
tangles.h = fixdiv( am->controls.heading_time, ROT_SPEED_DIVISOR );
tangles.b = fixdiv( am->controls.bank_time, ROT_SPEED_DIVISOR*2 );
vm_angles_2_matrix(&tempm, &tangles);
vm_matrix_x_matrix(&new_m,&am->viewMatrix,&tempm);
am->viewMatrix = new_m;
check_and_fix_matrix(&am->viewMatrix);
}
if ( am->controls.forward_thrust_time || am->controls.vertical_thrust_time || am->controls.sideways_thrust_time )
{
vm_vec_scale_add2( &am->view_position, &am->viewMatrix.fvec, am->controls.forward_thrust_time*ZOOM_SPEED_FACTOR );
vm_vec_scale_add2( &am->view_position, &am->viewMatrix.uvec, am->controls.vertical_thrust_time*SLIDE_SPEED );
vm_vec_scale_add2( &am->view_position, &am->viewMatrix.rvec, am->controls.sideways_thrust_time*SLIDE_SPEED );
// Crude wrapping check
if (am->view_position.x > F1_0*32000) am->view_position.x = F1_0*32000;
if (am->view_position.x < -F1_0*32000) am->view_position.x = -F1_0*32000;
if (am->view_position.y > F1_0*32000) am->view_position.y = F1_0*32000;
if (am->view_position.y < -F1_0*32000) am->view_position.y = -F1_0*32000;
if (am->view_position.z > F1_0*32000) am->view_position.z = F1_0*32000;
if (am->view_position.z < -F1_0*32000) am->view_position.z = -F1_0*32000;
}
}
else
{
if ( am->controls.fire_primary_count > 0)
{
// Reset orientation
am->viewDist = ZOOM_DEFAULT;
am->tangles.p = PITCH_DEFAULT;
am->tangles.h = 0;
am->tangles.b = 0;
am->view_target = Objects[Players[Player_num].objnum].pos;
am->controls.fire_primary_count = 0;
}
am->viewDist -= am->controls.forward_thrust_time*ZOOM_SPEED_FACTOR;
am->tangles.p += fixdiv( am->controls.pitch_time, ROT_SPEED_DIVISOR );
am->tangles.h += fixdiv( am->controls.heading_time, ROT_SPEED_DIVISOR );
am->tangles.b += fixdiv( am->controls.bank_time, ROT_SPEED_DIVISOR*2 );
if ( am->controls.vertical_thrust_time || am->controls.sideways_thrust_time )
{
vms_angvec tangles1;
vms_vector old_vt;
old_vt = am->view_target;
tangles1 = am->tangles;
vm_angles_2_matrix(&tempm,&tangles1);
vm_matrix_x_matrix(&am->viewMatrix,&Objects[Players[Player_num].objnum].orient,&tempm);
vm_vec_scale_add2( &am->view_target, &am->viewMatrix.uvec, am->controls.vertical_thrust_time*SLIDE_SPEED );
vm_vec_scale_add2( &am->view_target, &am->viewMatrix.rvec, am->controls.sideways_thrust_time*SLIDE_SPEED );
if ( vm_vec_dist_quick( &am->view_target, &Objects[Players[Player_num].objnum].pos) > i2f(1000) )
am->view_target = old_vt;
}
vm_angles_2_matrix(&tempm,&am->tangles);
vm_matrix_x_matrix(&am->viewMatrix,&Objects[Players[Player_num].objnum].orient,&tempm);
if ( am->viewDist < ZOOM_MIN_VALUE ) am->viewDist = ZOOM_MIN_VALUE;
if ( am->viewDist > ZOOM_MAX_VALUE ) am->viewDist = ZOOM_MAX_VALUE;
}
return 0;
}
// -----------------------------------------------------------------------------------------------------------
// add rotational velocity & acceleration
void do_physics_sim_rot(object *obj)
{
vms_angvec tangles;
vms_matrix rotmat,new_orient;
//fix rotdrag_scale;
physics_info *pi;
Assert(FrameTime > 0); //Get MATT if hit this!
pi = &obj->mtype.phys_info;
if (!(pi->rotvel.x || pi->rotvel.y || pi->rotvel.z || pi->rotthrust.x || pi->rotthrust.y || pi->rotthrust.z))
return;
if (obj->mtype.phys_info.drag) {
int count;
vms_vector accel;
fix drag,r,k;
count = FrameTime / FT;
r = FrameTime % FT;
k = fixdiv(r,FT);
drag = (obj->mtype.phys_info.drag*5)/2;
const char ORIGINAL = 0;
const char LINEAR_INTERPOLATION = 1;
const char GEOMETRIC_DRAG = 2;
const char STRATEGY = ORIGINAL;
if (obj->mtype.phys_info.flags & PF_USES_THRUST) {
vm_vec_copy_scale(&accel,&obj->mtype.phys_info.rotthrust,fixdiv(f1_0,obj->mtype.phys_info.mass));
}
if(STRATEGY == ORIGINAL) {
while (count--) {
if (obj->mtype.phys_info.flags & PF_USES_THRUST) {
vm_vec_add2(&obj->mtype.phys_info.rotvel,&accel);
}
vm_vec_scale(&obj->mtype.phys_info.rotvel,f1_0-drag);
}
//do linear scale on remaining bit of time
if (obj->mtype.phys_info.flags & PF_USES_THRUST) {
vm_vec_scale_add2(&obj->mtype.phys_info.rotvel,&accel,k);
}
vm_vec_scale(&obj->mtype.phys_info.rotvel,f1_0-fixmul(k,drag));
} else if (STRATEGY == LINEAR_INTERPOLATION) {
vms_vector target_rotvel;
vm_vec_copy_scale(&target_rotvel, &obj->mtype.phys_info.rotvel, F1_0);
// Target 21.3 FPS -- three iterations
for(int i = 0; i < 3; i++) {
if (obj->mtype.phys_info.flags & PF_USES_THRUST) {
vm_vec_add2(&target_rotvel, &accel);
}
vm_vec_scale(&target_rotvel,f1_0-drag);
}
fix target_frametime = F1_0 / 64 * 3;
fix interpolation_fraction = fixdiv(FrameTime, target_frametime);
vm_vec_sub2(&target_rotvel, &obj->mtype.phys_info.rotvel);
vm_vec_scale(&target_rotvel, interpolation_fraction);
vm_vec_add2(&obj->mtype.phys_info.rotvel, &target_rotvel);
} else if(STRATEGY == GEOMETRIC_DRAG) {
while (count--) {
if (obj->mtype.phys_info.flags & PF_USES_THRUST) {
vm_vec_add2(&obj->mtype.phys_info.rotvel,&accel);
}
vm_vec_scale(&obj->mtype.phys_info.rotvel,f1_0-drag);
}
//do linear scale on remaining bit of time
if (obj->mtype.phys_info.flags & PF_USES_THRUST) {
vm_vec_scale_add2(&obj->mtype.phys_info.rotvel,&accel,k);
}
double target_frametime = 3.0/64.0;
const double fix_offset = 65536.0;
double interpolation_fraction = ((double)(r) / fix_offset) / target_frametime ;
double ddrag = (double)(drag) / fix_offset;
double kdrag = pow((1.0 - ddrag), interpolation_fraction*3);
fix fractional_drag = (fix)(kdrag * fix_offset);
vm_vec_scale(&obj->mtype.phys_info.rotvel,fractional_drag);
//vm_vec_scale(&obj->mtype.phys_info.rotvel,f1_0-fixmul(k,drag));
}
/*
fix k_drag = f1_0-fixmul(k,drag);
if(FrameTime < F1_0/30) {
// Pegged to 30 FPS for now
double fix_offset = (double) F1_0;
double target_framerate = 20.0;
double ddrag = ((double) drag)/fix_offset;
//double target_drag = (1.0-ddrag)*(1.0-ddrag)*(1.0-ddrag*2.0/15.0); // Drag value multiplied by at 30 hz
double target_drag = (1.0-ddrag)*(1.0-ddrag)*(1.0-ddrag)*(1.0-ddrag*2.0/15.0); // Drag value at 20 hz
double frame_pow = 20.0 * ((double)(FrameTime)/fix_offset);
double frame_drag = pow(target_drag, frame_pow);
k_drag = (fix) (frame_drag*fix_offset);
}
if (obj->mtype.phys_info.flags & PF_USES_THRUST) {
vm_vec_copy_scale(&accel,&obj->mtype.phys_info.rotthrust,fixdiv(f1_0,obj->mtype.phys_info.mass));
// CED -- fix this for frame independence!
while (count--) {
vm_vec_add2(&obj->mtype.phys_info.rotvel,&accel);
vm_vec_scale(&obj->mtype.phys_info.rotvel,f1_0-drag);
}
//do linear scale on remaining bit of time
vm_vec_scale_add2(&obj->mtype.phys_info.rotvel,&accel,k);
//vm_vec_scale(&obj->mtype.phys_info.rotvel,f1_0-fixmul(k,drag));
vm_vec_scale(&obj->mtype.phys_info.rotvel,k_drag);
}
else
{
fix total_drag=f1_0;
while (count--)
total_drag = fixmul(total_drag,f1_0-drag);
//do linear scale on remaining bit of time
//total_drag = fixmul(total_drag,f1_0-fixmul(k,drag));
total_drag = fixmul(total_drag,k_drag);
vm_vec_scale(&obj->mtype.phys_info.rotvel,total_drag);
}
*/
}
//now rotate object
//unrotate object for bank caused by turn
if (obj->mtype.phys_info.turnroll) {
vms_matrix new_pm;
tangles.p = tangles.h = 0;
tangles.b = -obj->mtype.phys_info.turnroll;
vm_angles_2_matrix(&rotmat,&tangles);
vm_matrix_x_matrix(&new_pm,&obj->orient,&rotmat);
obj->orient = new_pm;
}
tangles.p = fixmul(obj->mtype.phys_info.rotvel.x,FrameTime);
tangles.h = fixmul(obj->mtype.phys_info.rotvel.y,FrameTime);
tangles.b = fixmul(obj->mtype.phys_info.rotvel.z,FrameTime);
vm_angles_2_matrix(&rotmat,&tangles);
vm_matrix_x_matrix(&new_orient,&obj->orient,&rotmat);
obj->orient = new_orient;
if (obj->mtype.phys_info.flags & PF_TURNROLL)
set_object_turnroll(obj);
//re-rotate object for bank caused by turn
if (obj->mtype.phys_info.turnroll) {
vms_matrix new_pm;
tangles.p = tangles.h = 0;
tangles.b = obj->mtype.phys_info.turnroll;
vm_angles_2_matrix(&rotmat,&tangles);
vm_matrix_x_matrix(&new_pm,&obj->orient,&rotmat);
obj->orient = new_pm;
}
check_and_fix_matrix(&obj->orient);
}
