458     f32                     f1, vx,vy ;  in KPADCalibrateDPD()  local
469     f1 = sqrtf( vx * vx + vy * vy ) ;  in KPADCalibrateDPD()
470     if ( f1 <= 0.5f ) return (-1) ;         // Abnormal acceleration  in KPADCalibrateDPD()
471     kp->accXY_nrm_hori.x = vx / f1 ;  in KPADCalibrateDPD()
472     kp->accXY_nrm_hori.y = vy / f1 ;  in KPADCalibrateDPD()
506     f1 = 1.0f / sqrtf( vx * vx + vy * vy ) ;        // Should not be zero  in KPADCalibrateDPD()
507     kp->sec_nrm_hori.x = vx * f1 ;  in KPADCalibrateDPD()
508     kp->sec_nrm_hori.y = vy * f1 ;  in KPADCalibrateDPD()
513     kp->dist_org = kp->dist_vv1 * f1 ;  in KPADCalibrateDPD()
678     f32             f1,f2 ;  in calc_acc()  local
686             f1 = -f2 ;  in calc_acc()
688             f1 = f2 ;  in calc_acc()
692         if ( f1 >= kp->acc_play_radius ) {  in calc_acc()
694             f1 = 1.0f ;  in calc_acc()
697             f1 /= kp->acc_play_radius ;  in calc_acc()
698             f1 *= f1 ;      // Second power  in calc_acc()
699             f1 *= f1 ;      // Fourth power  in calc_acc()
701         f1 *= kp->acc_sensitivity ;  in calc_acc()
704         *acc += f1 * f2 ;  in calc_acc()
720     f32             f1, vx,vy, ax,ay ;  in calc_acc_horizon()  local
724     f1 = sqrtf( kp->hard_acc.x * kp->hard_acc.x + kp->hard_acc.y * kp->hard_acc.y ) ;  in calc_acc_horizon()
725     if ( f1 == 0.0f || f1 >= 2.0f ) return ;  in calc_acc_horizon()
726     ax = kp->hard_acc.x / f1 ;  in calc_acc_horizon()
727     ay = kp->hard_acc.y / f1 ;  in calc_acc_horizon()
730     if ( f1 > 1.0f ) {  in calc_acc_horizon()
731         f1 = 2.0f - f1 ;  in calc_acc_horizon()
733     f1 *= f1 * kp_acc_horizon_pw ;  in calc_acc_horizon()
740     ax = ( vx - kp->acc_horizon.x ) * f1 + kp->acc_horizon.x ;  in calc_acc_horizon()
741     ay = ( vy - kp->acc_horizon.y ) * f1 + kp->acc_horizon.y ;  in calc_acc_horizon()
744     f1 = sqrtf( ax * ax + ay * ay ) ;  in calc_acc_horizon()
745     if ( f1 == 0.0f ) return ;  in calc_acc_horizon()
746     kp->acc_horizon.x = ax / f1 ;  in calc_acc_horizon()
747     kp->acc_horizon.y = ay / f1 ;  in calc_acc_horizon()
766     f32             f1,f2, ax,ay ;  in calc_acc_vertical()  local
772     f1 = sqrtf( f2 + ay * ay ) ;  in calc_acc_vertical()
773     if ( f1 == 0.0f || f1 >= 2.0f ) return ;  in calc_acc_vertical()
774     ax /= f1 ;  in calc_acc_vertical()
775     ay /= f1 ;  in calc_acc_vertical()
778     if ( f1 > 1.0f ) {  in calc_acc_vertical()
779         f1 = 2.0f - f1 ;  in calc_acc_vertical()
781     f1 *= f1 * kp_acc_horizon_pw ;  in calc_acc_vertical()
784     ax = ( ax - sp->acc_vertical.x ) * f1 + sp->acc_vertical.x ;  in calc_acc_vertical()
785     ay = ( ay - sp->acc_vertical.y ) * f1 + sp->acc_vertical.y ;  in calc_acc_vertical()
788     f1 = sqrtf( ax * ax + ay * ay ) ;  in calc_acc_vertical()
789     if ( f1 == 0.0f ) return ;  in calc_acc_vertical()
790     sp->acc_vertical.x = ax / f1 ;  in calc_acc_vertical()
791     sp->acc_vertical.y = ay / f1 ;  in calc_acc_vertical()
966     f32             f1, vx,vy ;  in calc_horizon()  local
971     f1 = 1.0f / sqrtf( vx * vx + vy * vy ) ;        // Should not be zero  in calc_horizon()
972     vx *= f1 ;  in calc_horizon()
973     vy *= f1 ;  in calc_horizon()
978     return ( kp->dist_vv1 * f1 ) ;  in calc_horizon()
989     f32             f1, max = kp_err_first_inpr ;  in select_2obj_first()  local
999             f1 = calc_horizon( kp, &op1->center, &op2->center, &hori ) ;  in select_2obj_first()
1002             if ( f1 <= kp->err_dist_min || f1 >= kp_err_dist_max ) continue ;  in select_2obj_first()
1004             f1 = kp->acc_horizon.x * hori.x + kp->acc_horizon.y * hori.y ;  in select_2obj_first()
1005             if ( f1 < 0.0f ) {  in select_2obj_first()
1006                 if ( -f1 > max ) {  in select_2obj_first()
1007                     max = -f1 ;  in select_2obj_first()
1012                 if ( f1 > max ) {  in select_2obj_first()
1013                     max = f1 ;  in select_2obj_first()
1040     f32             f1,f2, vx,vy, min = 2.0f ;  in select_2obj_continue()  local
1055             f1 = 1.0f / sqrtf( vx*vx + vy*vy ) ;    // Should not be zero  in select_2obj_continue()
1056             nrm.x = vx * f1 ;  in select_2obj_continue()
1057             nrm.y = vy * f1 ;  in select_2obj_continue()
1060             f1 *= kp->dist_vv1 ;             // Distance  in select_2obj_continue()
1061             if ( f1 <= kp->err_dist_min || f1 >= kp_err_dist_max ) continue ;  in select_2obj_continue()
1064             f1 -= kp->sec_dist ;  in select_2obj_continue()
1065             if ( f1 < 0.0f ) {  in select_2obj_continue()
1066                 f1 *= kp->err_dist_speedM_1 ;  in select_2obj_continue()
1068                 f1 *= kp->err_dist_speed_1 ;  in select_2obj_continue()
1070             if ( f1 >= 1.0f ) continue ;    // Distance error rate  in select_2obj_continue()
1084             f1 += f2 ;      // Determine through the sum of distance error rate and tilt error rate  in select_2obj_continue()
1085             if ( f1 < min ) {  in select_2obj_continue()
1086                 min = f1 ;  in select_2obj_continue()
1178     f32             f1, vx,vy ;  in select_1obj_continue()  local
1194             f1 = vx * vx + vy * vy ;  in select_1obj_continue()
1195             if ( f1 < min ) {  in select_1obj_continue()
1196                 min = f1 ;  in select_1obj_continue()
1240     f32             f1, vx,vy ;  in calc_obj_horizon()  local
1247     f1 = 1.0f / kp->sec_length ;  in calc_obj_horizon()
1248     kp->sec_dist = kp->dist_vv1 * f1 ;  in calc_obj_horizon()
1250     kp->sec_nrm.x = ( vx *= f1 ) ;  in calc_obj_horizon()
1251     kp->sec_nrm.y = ( vy *= f1 ) ;  in calc_obj_horizon()
1264     f32             f1,f2, dist ;  in calc_dpd_variable()  local
1290         f1 = sqrtf( vec.x * vec.x + vec.y * vec.y ) ;  in calc_dpd_variable()
1294             if ( f1 >= kp->hori_play_radius ) {  in calc_dpd_variable()
1296                 f1 = 1.0f ;  in calc_dpd_variable()
1299                 f1 /= kp->hori_play_radius ;  in calc_dpd_variable()
1300                 f1 *= f1 ;      // Second power  in calc_dpd_variable()
1301                 f1 *= f1 ;      // Fourth power  in calc_dpd_variable()
1303             f1 *= kp->hori_sensitivity ;  in calc_dpd_variable()
1306             vec.x = f1 * vec.x + sp->horizon.x ;  in calc_dpd_variable()
1307             vec.y = f1 * vec.y + sp->horizon.y ;  in calc_dpd_variable()
1308             f1 = sqrtf( vec.x * vec.x + vec.y * vec.y ) ;   // Normalize because this is tilt  in calc_dpd_variable()
1309             vec.x /= f1 ;  in calc_dpd_variable()
1310             vec.y /= f1 ;  in calc_dpd_variable()
1318             if ( f1 > kp->hori_play_radius ) {  in calc_dpd_variable()
1320                 f1 = ( f1 - kp->hori_play_radius ) / f1 * kp->hori_sensitivity ;  in calc_dpd_variable()
1321                 vec.x = vec.x * f1 + sp->horizon.x ;  in calc_dpd_variable()
1322                 vec.y = vec.y * f1 + sp->horizon.y ;  in calc_dpd_variable()
1323                 f1 = sqrtf( vec.x * vec.x + vec.y * vec.y ) ;  in calc_dpd_variable()
1324                 vec.x /= f1 ;  in calc_dpd_variable()
1325                 vec.y /= f1 ;  in calc_dpd_variable()
1356             f1 = -f2 ;  in calc_dpd_variable()
1358             f1 = f2 ;  in calc_dpd_variable()
1363             if ( f1 >= kp->dist_play_radius ) {  in calc_dpd_variable()
1365                 f1 = 1.0f ;  in calc_dpd_variable()
1368                 f1 /= kp->dist_play_radius ;  in calc_dpd_variable()
1369                 f1 *= f1 ;      // Second power  in calc_dpd_variable()
1370                 f1 *= f1 ;      // Fourth power  in calc_dpd_variable()
1372             f1 *= kp->dist_sensitivity ;  in calc_dpd_variable()
1375             sp->dist_vec = f1 * f2 ;  in calc_dpd_variable()
1384             if ( f1 > kp->dist_play_radius ) {  in calc_dpd_variable()
1386                 f1 = ( f1 - kp->dist_play_radius ) / f1 * kp->dist_sensitivity ;  in calc_dpd_variable()
1387                 sp->dist_vec = f1 * f2 ;  in calc_dpd_variable()
1411     f1 =  kp->sec_nrm.x * kp->sec_nrm_hori.x + kp->sec_nrm.y * kp->sec_nrm_hori.y ;  in calc_dpd_variable()
1413     vec.x = f1 * pos.x - f2 * pos.y ;  in calc_dpd_variable()
1414     vec.y = f2 * pos.x + f1 * pos.y ;  in calc_dpd_variable()
1434         f1 = sqrtf( vec.x * vec.x + vec.y * vec.y ) ;  in calc_dpd_variable()
1438             if ( f1 >= kp->pos_play_radius ) {  in calc_dpd_variable()
1440                 f1 = 1.0f ;  in calc_dpd_variable()
1443                 f1 /= kp->pos_play_radius ;  in calc_dpd_variable()
1444                 f1 *= f1 ;      // Second power  in calc_dpd_variable()
1445                 f1 *= f1 ;      // Fourth power  in calc_dpd_variable()
1447             f1 *= kp->pos_sensitivity ;  in calc_dpd_variable()
1450             sp->vec.x = f1 * vec.x ;  in calc_dpd_variable()
1451             sp->vec.y = f1 * vec.y ;  in calc_dpd_variable()
1457             if ( f1 > kp->pos_play_radius ) {  in calc_dpd_variable()
1459                 f1 = ( f1 - kp->pos_play_radius ) / f1 * kp->pos_sensitivity ;  in calc_dpd_variable()
1460                 sp->vec.x = f1 * vec.x ;  in calc_dpd_variable()
1461                 sp->vec.y = f1 * vec.y ;  in calc_dpd_variable()