490     f32                     f1, vx,vy ;  in KPADCalibrateDPD()  local
501     f1 = sqrtf( vx * vx + vy * vy ) ;  in KPADCalibrateDPD()
502     if ( f1 <= 0.5f ) return (-1) ;         // Abnormal acceleration  in KPADCalibrateDPD()
503     kp->accXY_nrm_hori.x = vx / f1 ;  in KPADCalibrateDPD()
504     kp->accXY_nrm_hori.y = vy / f1 ;  in KPADCalibrateDPD()
538     f1 = 1.0f / sqrtf( vx * vx + vy * vy ) ;        // Should not be zero  in KPADCalibrateDPD()
539     kp->sec_nrm_hori.x = vx * f1 ;  in KPADCalibrateDPD()
540     kp->sec_nrm_hori.y = vy * f1 ;  in KPADCalibrateDPD()
545     kp->dist_org = kp->dist_vv1 * f1 ;  in KPADCalibrateDPD()
731     f32             f1,f2 ;  in calc_acc()  local
739             f1 = -f2 ;  in calc_acc()
741             f1 = f2 ;  in calc_acc()
745         if ( f1 >= kp->acc_play_radius ) {  in calc_acc()
747             f1 = 1.0f ;  in calc_acc()
750             f1 /= kp->acc_play_radius ;  in calc_acc()
751             f1 *= f1 ;      // Second power  in calc_acc()
752             f1 *= f1 ;      // Fourth power  in calc_acc()
754         f1 *= kp->acc_sensitivity ;  in calc_acc()
757         *acc += f1 * f2 ;  in calc_acc()
773     f32             f1, vx,vy, ax,ay ;  in calc_acc_horizon()  local
777     f1 = sqrtf( kp->hard_acc.x * kp->hard_acc.x + kp->hard_acc.y * kp->hard_acc.y ) ;  in calc_acc_horizon()
778     if ( f1 == 0.0f || f1 >= 2.0f ) return ;  in calc_acc_horizon()
779     ax = kp->hard_acc.x / f1 ;  in calc_acc_horizon()
780     ay = kp->hard_acc.y / f1 ;  in calc_acc_horizon()
783     if ( f1 > 1.0f ) {  in calc_acc_horizon()
784         f1 = 2.0f - f1 ;  in calc_acc_horizon()
786     f1 *= f1 * kp_acc_horizon_pw ;  in calc_acc_horizon()
793     ax = ( vx - kp->acc_horizon.x ) * f1 + kp->acc_horizon.x ;  in calc_acc_horizon()
794     ay = ( vy - kp->acc_horizon.y ) * f1 + kp->acc_horizon.y ;  in calc_acc_horizon()
797     f1 = sqrtf( ax * ax + ay * ay ) ;  in calc_acc_horizon()
798     if ( f1 == 0.0f ) return ;  in calc_acc_horizon()
799     kp->acc_horizon.x = ax / f1 ;  in calc_acc_horizon()
800     kp->acc_horizon.y = ay / f1 ;  in calc_acc_horizon()
819     f32             f1,f2, ax,ay ;  in calc_acc_vertical()  local
825     f1 = sqrtf( f2 + ay * ay ) ;  in calc_acc_vertical()
826     if ( f1 == 0.0f || f1 >= 2.0f ) return ;  in calc_acc_vertical()
827     ax /= f1 ;  in calc_acc_vertical()
828     ay /= f1 ;  in calc_acc_vertical()
831     if ( f1 > 1.0f ) {  in calc_acc_vertical()
832         f1 = 2.0f - f1 ;  in calc_acc_vertical()
834     f1 *= f1 * kp_acc_horizon_pw ;  in calc_acc_vertical()
837     ax = ( ax - sp->acc_vertical.x ) * f1 + sp->acc_vertical.x ;  in calc_acc_vertical()
838     ay = ( ay - sp->acc_vertical.y ) * f1 + sp->acc_vertical.y ;  in calc_acc_vertical()
841     f1 = sqrtf( ax * ax + ay * ay ) ;  in calc_acc_vertical()
842     if ( f1 == 0.0f ) return ;  in calc_acc_vertical()
843     sp->acc_vertical.x = ax / f1 ;  in calc_acc_vertical()
844     sp->acc_vertical.y = ay / f1 ;  in calc_acc_vertical()
1020     f32             f1, vx,vy ;  in calc_horizon()  local
1025     f1 = 1.0f / sqrtf( vx * vx + vy * vy ) ;        // Should not be zero  in calc_horizon()
1026     vx *= f1 ;  in calc_horizon()
1027     vy *= f1 ;  in calc_horizon()
1032     return ( kp->dist_vv1 * f1 ) ;  in calc_horizon()
1043     f32             f1, max = kp_err_first_inpr ;  in select_2obj_first()  local
1053             f1 = calc_horizon( kp, &op1->center, &op2->center, &hori ) ;  in select_2obj_first()
1056             if ( f1 <= kp->err_dist_min || f1 >= kp_err_dist_max ) continue ;  in select_2obj_first()
1058             f1 = kp->acc_horizon.x * hori.x + kp->acc_horizon.y * hori.y ;  in select_2obj_first()
1059             if ( f1 < 0.0f ) {  in select_2obj_first()
1060                 if ( -f1 > max ) {  in select_2obj_first()
1061                     max = -f1 ;  in select_2obj_first()
1066                 if ( f1 > max ) {  in select_2obj_first()
1067                     max = f1 ;  in select_2obj_first()
1094     f32             f1,f2, vx,vy, min = 2.0f ;  in select_2obj_continue()  local
1109             f1 = 1.0f / sqrtf( vx*vx + vy*vy ) ;    // Should not be zero.  in select_2obj_continue()
1110             nrm.x = vx * f1 ;  in select_2obj_continue()
1111             nrm.y = vy * f1 ;  in select_2obj_continue()
1114             f1 *= kp->dist_vv1 ;             // Distance  in select_2obj_continue()
1115             if ( f1 <= kp->err_dist_min || f1 >= kp_err_dist_max ) continue ;  in select_2obj_continue()
1118             f1 -= kp->sec_dist ;  in select_2obj_continue()
1119             if ( f1 < 0.0f ) {  in select_2obj_continue()
1120                 f1 *= kp->err_dist_speedM_1 ;  in select_2obj_continue()
1122                 f1 *= kp->err_dist_speed_1 ;  in select_2obj_continue()
1124             if ( f1 >= 1.0f ) continue ;    // Distance error rate  in select_2obj_continue()
1138             f1 += f2 ;      // Determine through the sum of distance error rate and tilt error rate  in select_2obj_continue()
1139             if ( f1 < min ) {  in select_2obj_continue()
1140                 min = f1 ;  in select_2obj_continue()
1232     f32             f1, vx,vy ;  in select_1obj_continue()  local
1248             f1 = vx * vx + vy * vy ;  in select_1obj_continue()
1249             if ( f1 < min ) {  in select_1obj_continue()
1250                 min = f1 ;  in select_1obj_continue()
1294     f32             f1, vx,vy ;  in calc_obj_horizon()  local
1301     f1 = 1.0f / kp->sec_length ;  in calc_obj_horizon()
1302     kp->sec_dist = kp->dist_vv1 * f1 ;  in calc_obj_horizon()
1304     kp->sec_nrm.x = ( vx *= f1 ) ;  in calc_obj_horizon()
1305     kp->sec_nrm.y = ( vy *= f1 ) ;  in calc_obj_horizon()
1318     f32             f1,f2, dist ;  in calc_dpd_variable()  local
1344         f1 = sqrtf( vec.x * vec.x + vec.y * vec.y ) ;  in calc_dpd_variable()
1348             if ( f1 >= kp->hori_play_radius ) {  in calc_dpd_variable()
1350                 f1 = 1.0f ;  in calc_dpd_variable()
1353                 f1 /= kp->hori_play_radius ;  in calc_dpd_variable()
1354                 f1 *= f1 ;      // Second power  in calc_dpd_variable()
1355                 f1 *= f1 ;      // Fourth power  in calc_dpd_variable()
1357             f1 *= kp->hori_sensitivity ;  in calc_dpd_variable()
1360             vec.x = f1 * vec.x + sp->horizon.x ;  in calc_dpd_variable()
1361             vec.y = f1 * vec.y + sp->horizon.y ;  in calc_dpd_variable()
1362             f1 = sqrtf( vec.x * vec.x + vec.y * vec.y ) ;   // Normalize because this is tilt  in calc_dpd_variable()
1363             vec.x /= f1 ;  in calc_dpd_variable()
1364             vec.y /= f1 ;  in calc_dpd_variable()
1372             if ( f1 > kp->hori_play_radius ) {  in calc_dpd_variable()
1374                 f1 = ( f1 - kp->hori_play_radius ) / f1 * kp->hori_sensitivity ;  in calc_dpd_variable()
1375                 vec.x = vec.x * f1 + sp->horizon.x ;  in calc_dpd_variable()
1376                 vec.y = vec.y * f1 + sp->horizon.y ;  in calc_dpd_variable()
1377                 f1 = sqrtf( vec.x * vec.x + vec.y * vec.y ) ;  in calc_dpd_variable()
1378                 vec.x /= f1 ;  in calc_dpd_variable()
1379                 vec.y /= f1 ;  in calc_dpd_variable()
1410             f1 = -f2 ;  in calc_dpd_variable()
1412             f1 = f2 ;  in calc_dpd_variable()
1417             if ( f1 >= kp->dist_play_radius ) {  in calc_dpd_variable()
1419                 f1 = 1.0f ;  in calc_dpd_variable()
1422                 f1 /= kp->dist_play_radius ;  in calc_dpd_variable()
1423                 f1 *= f1 ;      // Second power  in calc_dpd_variable()
1424                 f1 *= f1 ;      // Fourth power  in calc_dpd_variable()
1426             f1 *= kp->dist_sensitivity ;  in calc_dpd_variable()
1429             sp->dist_vec = f1 * f2 ;  in calc_dpd_variable()
1438             if ( f1 > kp->dist_play_radius ) {  in calc_dpd_variable()
1440                 f1 = ( f1 - kp->dist_play_radius ) / f1 * kp->dist_sensitivity ;  in calc_dpd_variable()
1441                 sp->dist_vec = f1 * f2 ;  in calc_dpd_variable()
1465     f1 =  kp->sec_nrm.x * kp->sec_nrm_hori.x + kp->sec_nrm.y * kp->sec_nrm_hori.y ;  in calc_dpd_variable()
1467     vec.x = f1 * pos.x - f2 * pos.y ;  in calc_dpd_variable()
1468     vec.y = f2 * pos.x + f1 * pos.y ;  in calc_dpd_variable()
1488         f1 = sqrtf( vec.x * vec.x + vec.y * vec.y ) ;  in calc_dpd_variable()
1492             if ( f1 >= kp->pos_play_radius ) {  in calc_dpd_variable()
1494                 f1 = 1.0f ;  in calc_dpd_variable()
1497                 f1 /= kp->pos_play_radius ;  in calc_dpd_variable()
1498                 f1 *= f1 ;      // Second power  in calc_dpd_variable()
1499                 f1 *= f1 ;      // Fourth power  in calc_dpd_variable()
1501             f1 *= kp->pos_sensitivity ;  in calc_dpd_variable()
1504             sp->vec.x = f1 * vec.x ;  in calc_dpd_variable()
1505             sp->vec.y = f1 * vec.y ;  in calc_dpd_variable()
1511             if ( f1 > kp->pos_play_radius ) {  in calc_dpd_variable()
1513                 f1 = ( f1 - kp->pos_play_radius ) / f1 * kp->pos_sensitivity ;  in calc_dpd_variable()
1514                 sp->vec.x = f1 * vec.x ;  in calc_dpd_variable()
1515                 sp->vec.y = f1 * vec.y ;  in calc_dpd_variable()