cam rework

[carveJwlIkooP6JGAAIwe30JlM.git] / player_walk.c

#ifndef PLAYER_WALK_C
#define PLAYER_WALK_C

#include "player.h"

VG_STATIC void player_walk_transfer_to_skate( player_instance *player,
                                              enum skate_activity init )
{
   struct player_walk *w = &player->_walk;

   v3f xy_speed, v;

   v3_copy( player->rb.v, xy_speed );
   xy_speed[1] = 0.0f;

   if( v3_length2( xy_speed ) < 0.1f * 0.1f )
   {
      v[0] = -sinf( -w->state.angles[0] );
      v[1] =  0.0f;
      v[2] = -cosf( -w->state.angles[0] );
      v3_muls( v, 1.6f, v );
   }
   else
      v3_copy( player->rb.v, v );

   player->subsystem = k_player_subsystem_skate;
   player__skate_transition( player, v, init );
   return;
}

VG_STATIC void player__walk_pre_update( player_instance *player )
{
   struct player_walk *w = &player->_walk;
   player_look( player, w->state.angles );

   if( w->state.outro_anim )
   {
      float outro_length = (float)w->state.outro_anim->length /
                                  w->state.outro_anim->rate,
            outro_time   = vg.time - w->state.outro_start_time;

      if( outro_time >= outro_length )
      {
         w->state.outro_anim = NULL;
         player_walk_transfer_to_skate( player, k_skate_activity_air );
         return;
      }
   }
   else if( vg_input_button_down( player->input_use ) )
   {
      if( w->state.activity == k_walk_activity_ground )
      {
         player_walk_transfer_to_skate( player, k_skate_activity_ground );
      }
      else
      {
         w->state.outro_anim = w->anim_jump_to_air;
         w->state.outro_start_time = vg.time;
         v3_copy( player->cam.pos, player->follow_pos );
         v3_copy( player->cam.angles, player->follow_angles );
         return;
      }
   }
}

VG_STATIC int player_walk_normal_standable( v3f n )
{
   return n[1] > 0.70710678118f;
}

VG_STATIC void player_accelerate( v3f v, v3f movedir, float speed, float accel )
{
   float currentspeed = v3_dot( v, movedir ),
         addspeed     = speed - currentspeed;

   if( addspeed <= 0 )
      return;

   float accelspeed = accel * k_rb_delta * speed;

   if( accelspeed > addspeed )
      accelspeed = addspeed;

   v3_muladds( v, movedir, accelspeed, v );
}

VG_STATIC void player_friction( v3f v )
{
   float speed = v3_length( v ),
         drop  = 0.0f,
         control = vg_maxf( speed, k_stopspeed );

   if( speed < 0.04f )
      return;

   drop += control * k_walk_friction * k_rb_delta;

   float newspeed = vg_maxf( 0.0f, speed - drop );
   newspeed /= speed;

   v3_muls( v, newspeed, v );
}

VG_STATIC void player__walk_update( player_instance *player )
{
   struct player_walk *w = &player->_walk;
   v3_copy( player->rb.co, w->state.prev_pos );

   w->collider.height = 2.0f;
   w->collider.radius = 0.3f;

   m4x3f mtx;
   m3x3_identity( mtx );
   v3_add( player->rb.co, (v3f){0.0f, 1.0f, 0.0f}, mtx[3] );

   debug_capsule( mtx, w->collider.radius, w->collider.height, VG__WHITE );

   rb_ct manifold[64];
   int len;

   float yaw = w->state.angles[0];

   v3f forward_dir = { sinf(yaw),          0.0f, -cosf(yaw) };
   v3f right_dir   = { -forward_dir[2],    0.0f,  forward_dir[0] };

   v2f walk = { player->input_walkh->axis.value,
                player->input_walkv->axis.value };

   if( v2_length2(walk) > 0.001f )
      v2_normalize_clamp( walk );

   w->move_speed = v2_length( walk );

   /* 
    * Collision detection
    */
   len = rb_capsule__scene( mtx, &w->collider, NULL, 
                            &world.rb_geo.inf.scene, manifold );
   rb_manifold_filter_coplanar( manifold, len, 0.01f );
   len = rb_manifold_apply_filtered( manifold, len );

   v3f surface_avg = { 0.0f, 0.0f, 0.0f };
   w->state.activity = k_walk_activity_air;

   for( int i=0; i<len; i++ )
   {
      struct contact *ct = &manifold[i];
      rb_debug_contact( ct );

      if( player_walk_normal_standable( ct->n ) )
      {
         w->state.activity = k_walk_activity_ground;
         v3_add( surface_avg, ct->n, surface_avg );
      }

      rb_prepare_contact( ct );
   }

   /* 
    * Move & Friction
    */
   float accel_speed = 0.0f, nominal_speed = 0.0f;
   v3f movedir;
   v3_muls( right_dir,   walk[0], movedir );
   v3_muladds( movedir, forward_dir, walk[1], movedir );

   if( w->state.activity == k_walk_activity_ground )
   {
      v3_normalize( surface_avg );

      v3f tx, ty;
      rb_tangent_basis( surface_avg, tx, ty );

      if( v2_length2(walk) > 0.001f )
      {
         /* clip movement to the surface */
         float d = v3_dot(surface_avg,movedir);
         v3_muladds( movedir, surface_avg, -d, movedir );
      }

      accel_speed = k_walk_accel;
      nominal_speed = k_walkspeed;

      /* jump */
      if( player->input_jump->button.value )
      {
         player->rb.v[1] = 5.0f;
         w->state.activity = k_walk_activity_air;
         accel_speed = k_walk_air_accel;
         nominal_speed = k_airspeed;
      }
      else
      {
         player_friction( player->rb.v );

         struct world_material *surface_mat = world_contact_material(manifold);
         w->surface = surface_mat->info.surface_prop;
      }
   }
   else
   {
      accel_speed = k_walk_air_accel;
      nominal_speed = k_airspeed;
   }

   if( v2_length2(walk) > 0.001f )
   {
      player_accelerate( player->rb.v, movedir, nominal_speed, accel_speed );
      v3_normalize( movedir );
   }
   
   /*
    * Resolve velocity constraints
    */
   for( int j=0; j<5; j++ )
   {
      for( int i=0; i<len; i++ )
      {
         struct contact *ct = &manifold[i];
         
         /*normal */
         float vn = -v3_dot( player->rb.v, ct->n );

         float temp = ct->norm_impulse;
         ct->norm_impulse = vg_maxf( temp + vn, 0.0f );
         vn = ct->norm_impulse - temp;

         v3_muladds( player->rb.v, ct->n, vn, player->rb.v );
      }
   }

   /* 
    * Depenetrate
    */
   v3f dt;
   v3_zero( dt );
   for( int j=0; j<8; j++ )
   {
      for( int i=0; i<len; i++ )
      {
         struct contact *ct = &manifold[i];

         float resolved_amt = v3_dot( ct->n, dt ),
               remaining    = (ct->p-k_penetration_slop) - resolved_amt,
               apply        = vg_maxf( remaining, 0.0f ) * 0.3f;

         v3_muladds( dt, ct->n, apply, dt );
      }
   }
   v3_add( dt, player->rb.co, player->rb.co );

   /* TODO: Stepping......
    *
    *        ideas; walkgrid style steps
    */
#if 0
   if( w->state.activity == k_walk_activity_ground )
   {
      /* step */
      float max_dist = 0.4f;

      v3f pa, pb;
      v3_copy( player->rb.co, pa );
      pa[1] += w->collider.radius + max_dist;

      v3_muladds( pa, (v3f){0.0f,1.0f,0.0f}, -max_dist * 2.0f, pb );
      vg_line( pa, pb, 0xff000000 );

      v3f n;
      float t;
      if( spherecast_world( pa, pb, w->collider.radius, &t, n ) != -1 )
      {
         if( player_walk_normal_standable( n ) )
         {
            v3_lerp( pa, pb, t, player->rb.co );
            player->rb.co[1] -= w->collider.radius;
         }
      }
   }
#endif


   /* integrate */
   if( w->state.activity == k_walk_activity_air )
      player->rb.v[1] += -k_gravity * k_rb_delta;

   v3_muladds( player->rb.co, player->rb.v, k_rb_delta, player->rb.co );


   v3_add( player->rb.co, (v3f){0.0f, 1.0f, 0.0f}, mtx[3] );
   debug_capsule( mtx, w->collider.radius, w->collider.height, VG__GREEN );

   /* 
    * CCD routine 
    * ---------------------------------------------------
    *
    */
   v3f lwr_prev,
       lwr_now,
       lwr_offs = { 0.0f, w->collider.radius, 0.0f };

   v3_add( lwr_offs, w->state.prev_pos, lwr_prev );
   v3_add( lwr_offs, player->rb.co, lwr_now );

   v3f movedelta;
   v3_sub( player->rb.co, w->state.prev_pos, movedelta );

   float movedist = v3_length( movedelta );

   if( movedist > 0.3f )
   {
      float t, sr = w->collider.radius-0.04f;
      v3f n;

      if( spherecast_world( lwr_prev, lwr_now, sr, &t, n ) != -1 )
      {
         v3_lerp( lwr_prev, lwr_now, vg_maxf(0.01f,t), player->rb.co );
         player->rb.co[1] -= w->collider.radius;
         rb_update_transform( &player->rb );

         v3_add( player->rb.co, (v3f){0.0f, 1.0f, 0.0f}, mtx[3] );
         debug_capsule( mtx, w->collider.radius, w->collider.height, VG__RED );
      }
   }

   teleport_gate *gate;
   if( (gate = world_intersect_gates( player->rb.co, w->state.prev_pos )) )
   {
      m4x3_mulv( gate->transport, player->rb.co, player->rb.co );
      m3x3_mulv( gate->transport, player->rb.v,  player->rb.v );
      rb_update_transform( &player->rb );

      /* analytical rotation of yaw */
      v3f fwd_dir = { cosf(w->state.angles[0]),
                      0.0f,
                      sinf(w->state.angles[0])};
      m3x3_mulv( gate->transport, fwd_dir, fwd_dir );
      w->state.angles[0] = atan2f( fwd_dir[2], fwd_dir[0] );

      w->state_gate_storage = w->state;
      player__pass_gate( player, gate );
   }
}

VG_STATIC void player__walk_post_update( player_instance *player )
{
   struct player_walk *w = &player->_walk;

   m4x3f mtx;
   m3x3_identity( mtx );
   v3_add( player->rb.co, (v3f){0.0f, 1.0f, 0.0f}, mtx[3] );

   float substep = vg_clampf( vg.accumulator / k_rb_delta, 0.0f, 1.0f );
   v3_muladds( mtx[3], player->rb.v, k_rb_delta*substep, mtx[3] );
   debug_capsule( mtx, w->collider.radius, w->collider.height, VG__YELOW );


   /* Calculate header */
   v3f xy_speed, v;

   v3_copy( player->rb.v, xy_speed );
   xy_speed[1] = 0.0f;

   if( v3_length2( xy_speed ) > 0.1f * 0.1f )
      w->state.heading_angle = atan2f( player->rb.v[0], player->rb.v[2] );
}

VG_STATIC void player__walk_animate( player_instance *player, 
                                    player_animation *dest )
{
   struct player_walk *w = &player->_walk;
   struct skeleton *sk = &player->playeravatar->sk;

   {
      float fly = (w->state.activity == k_walk_activity_air)? 1.0f: 0.0f,
            rate;

      if( w->state.activity == k_walk_activity_air )
         rate = 2.4f;
      else
         rate = 9.0f;

      w->blend_fly = vg_lerpf( w->blend_fly, fly, rate*vg.time_delta );
      w->blend_run = vg_lerpf( w->blend_run,
                               w->move_speed *
                               (1.0f + player->input_walk->button.value*0.5f),
                               2.0f*vg.time_delta );
   }

   player_pose apose, bpose;

   if( w->move_speed > 0.025f )
   {
      /* TODO move */
      float walk_norm = 30.0f/(float)w->anim_walk->length,
            run_norm  = 30.0f/(float)w->anim_run->length,
            walk_adv  = vg_lerpf( walk_norm, run_norm, w->move_speed );

      w->walk_timer += walk_adv * vg.time_delta;
   }
   else
   {
      w->walk_timer = 0.0f;
   }

   float walk_norm = (float)w->anim_walk->length/30.0f,
         run_norm  = (float)w->anim_run->length/30.0f,
         t = w->walk_timer,
         l = vg_clampf( w->blend_run*15.0f, 0.0f, 1.0f ),
         idle_walk = vg_clampf( (w->blend_run-0.1f)/(1.0f-0.1f), 0.0f, 1.0f );

   /* walk/run */
   skeleton_sample_anim( sk, w->anim_walk, t*walk_norm, apose );
   skeleton_sample_anim( sk, w->anim_run,  t*run_norm, bpose );

   skeleton_lerp_pose( sk, apose, bpose, l, apose );

   /* idle */
   skeleton_sample_anim( sk, w->anim_idle, vg.time*0.1f, bpose );
   skeleton_lerp_pose( sk, apose, bpose, 1.0f-idle_walk, apose );

   /* air */
   skeleton_sample_anim( sk, w->anim_jump, vg.time*0.6f, bpose );
   skeleton_lerp_pose( sk, apose, bpose, w->blend_fly, apose );

   /* Create transform */
   rb_extrapolate( &player->rb, dest->root_co, dest->root_q );

   float walk_yaw = w->state.heading_angle + VG_PIf*0.5f;

   if( w->state.outro_anim )
   {
      float outro_length = (float)w->state.outro_anim->length /
                                  w->state.outro_anim->rate,
            outro_time   = vg.time - w->state.outro_start_time,
            outro_t      = outro_time / outro_length;

      walk_yaw += -VG_PIf*0.5f*outro_t;

      /* TODO: Compression */
      v3_muladds( dest->root_co, player->rb.to_world[1], 
                  -0.28f * outro_t, dest->root_co );

      skeleton_sample_anim_clamped( sk, w->state.outro_anim, 
                                    outro_time, bpose );
      skeleton_lerp_pose( sk, apose, bpose, outro_t * 10.0f, dest->pose );
   }
   else
   {
      skeleton_copy_pose( sk, apose, dest->pose );
   }

   q_axis_angle( dest->root_q, (v3f){0.0f,1.0f,0.0f}, walk_yaw );
}

VG_STATIC void player__walk_post_animate( player_instance *player )
{
   /* 
    * Camera 
    */
   struct player_walk *w = &player->_walk;
   struct player_avatar *av = player->playeravatar;

   /* 3RD */
   m3x3f angles;
   euler_m3x3( w->state.angles, angles );

   v3f cast_dir, origin;

   v3_add( player->rb.co, (v3f){0.0f,2.0f,0.0f}, origin );

   v3_muladds( origin, angles[2], 2.0f, player->override_pos );
   v3_muladds( player->override_pos, angles[0], 0.5f, player->override_pos );

   float t;
   v3f n;
   if( spherecast_world( origin, player->override_pos, 0.1f, &t, n ) != -1 )
      v3_lerp( origin, player->override_pos, t, player->override_pos );
   v3_copy( w->state.angles, player->override_angles );

   /* 1ST */
   /* FIXME: viewpoint entity */
   v3f vp = {-0.1f,1.8f,0.0f};
   m4x3_mulv( av->sk.final_mtx[ av->id_head-1 ], vp, player->fpv_pos );
   v3_copy( w->state.angles, player->fpv_angles );

   /* FIXME: Organize this. Its int wrong fucking place */
   v3f vp0 = {0.0f,0.1f, 0.6f},
       vp1 = {0.0f,0.1f,-0.6f};

   if( w->state.outro_anim )
   {
      float outro_length = (float)w->state.outro_anim->length /
                                  w->state.outro_anim->rate,
            outro_time   = vg.time - w->state.outro_start_time,
            outro_t      = outro_time / outro_length;

      /* FIXME: Compression */
      v3_add( player->rb.co, (v3f){0.0f,1.35f,0.0f}, origin );
      player_set_follower_subject( player, origin );

      player->cam_angles_override_strength   = 1.0f-outro_t;
      player->cam_position_override_strength = 1.0f-outro_t;


      v3f fpv_angles;
      player_vector_angles( fpv_angles, player->rb.v, 1.0f, 0.25f );
      v3_lerp( player->fpv_angles,fpv_angles, outro_t, player->fpv_angles );
   }
   else
   {
      player->cam_angles_override_strength = 1.0f;
      player->cam_position_override_strength = 1.0f;
   }

   m4x3_mulv( av->sk.final_mtx[ av->id_board ], vp0, TEMP_BOARD_0 );
   m4x3_mulv( av->sk.final_mtx[ av->id_board ], vp1, TEMP_BOARD_1 );
}


VG_STATIC void player__walk_im_gui( player_instance *player )
{
   struct player_walk *w = &player->_walk;
   player__debugtext( 1, "V:  %5.2f %5.2f %5.2f",player->rb.v[0],
                                                 player->rb.v[1],
                                                 player->rb.v[2] );
   player__debugtext( 1, "CO: %5.2f %5.2f %5.2f",player->rb.co[0],
                                                 player->rb.co[1],
                                                 player->rb.co[2] );
   player__debugtext( 1, "activity: %s\n",
                           (const char *[]){ "k_walk_activity_air",
                                             "k_walk_activity_ground",
                                             "k_walk_activity_sleep" }
                                             [w->state.activity] );

   if( w->state.outro_anim )
   {
      float outro_length = (float)w->state.outro_anim->length /
                                  w->state.outro_anim->rate,
            outro_time   = vg.time - w->state.outro_start_time;
      player__debugtext( 1, "outro time: %f / %f", outro_time, outro_length );
   }
}

VG_STATIC void player__walk_bind( player_instance *player )
{
   struct player_walk *w = &player->_walk;
   struct player_avatar *av = player->playeravatar;
   struct skeleton *sk = &av->sk;

   w->anim_idle         = skeleton_get_anim( sk, "idle_cycle" );
   w->anim_walk         = skeleton_get_anim( sk, "walk" );
   w->anim_run          = skeleton_get_anim( sk, "run" );
   w->anim_jump         = skeleton_get_anim( sk, "jump" );
   w->anim_jump_to_air  = skeleton_get_anim( sk, "jump_to_air" );
}

VG_STATIC void player__walk_transition( player_instance *player, v3f angles )
{
   struct player_walk *w = &player->_walk;
   v3_copy( angles, w->state.angles );
}

#endif /* PLAYER_DEVICE_WALK_H */