Lines Matching refs:sp
359 KPADStatus *sp = &kp->status ; in reset_kpad() local
378 sp->hold = sp->trig = sp->release = 0x00000000 ; in reset_kpad()
383 sp->dpd_valid_fg = 0 ; // Disabled in reset_kpad()
386 sp->pos = sp->vec = Vec2_0 ; in reset_kpad()
387 sp->speed = 0.0f ; in reset_kpad()
389 sp->horizon.x = kp->acc_horizon.x = kp->obj_horizon.x = 1.0f ; in reset_kpad()
390 sp->horizon.y = kp->acc_horizon.y = kp->obj_horizon.y = 0.0f ; in reset_kpad()
391 sp->hori_vec = Vec2_0 ; in reset_kpad()
392 sp->hori_speed = 0.0f ; in reset_kpad()
394 sp->acc_vertical.x = 1.0f ; in reset_kpad()
395 sp->acc_vertical.y = 0.0f ; in reset_kpad()
397 sp->dist = kp->dist_org ; in reset_kpad()
398 sp->dist_vec = sp->dist_speed = 0.0f ; in reset_kpad()
400 kp->sec_dist = sp->dist ; in reset_kpad()
405 sp->acc.x = sp->acc.z = 0.0f ; in reset_kpad()
406 sp->acc.y = -1.0f ; in reset_kpad()
407 sp->acc_value = 1.0f ; in reset_kpad()
408 sp->acc_speed = 0.0f ; in reset_kpad()
409 kp->hard_acc = sp->acc ; in reset_kpad()
456 KPADStatus *sp = &kp->status ; in KPADCalibrateDPD() local
518 sp->dpd_valid_fg = 0 ; // Invalid temporarily in KPADCalibrateDPD()
564 KPADStatus *sp = &kp->status ; in calc_button_repeat() local
567 if ( sp->trig != 0 || sp->release != 0 ) { in calc_button_repeat()
573 if ( sp->trig && kp->btn_repeat_pulse ) { in calc_button_repeat()
574 sp->hold |= KPAD_BUTTON_RPT ; in calc_button_repeat()
576 } else if ( sp->hold != 0 ) { in calc_button_repeat()
585 sp->hold |= KPAD_BUTTON_RPT ; in calc_button_repeat()
638 KPADStatus *sp = &kp->status ; in read_kpad_button() local
644 old_fg = sp->hold & KPAD_BUTTON_MASK ; in read_kpad_button()
647 sp->hold = ( core & (KPAD_BUTTON_MASK & ~(WPAD_BUTTON_Z | WPAD_BUTTON_C)) ) | in read_kpad_button()
651 change_fg = sp->hold ^ old_fg ; // Changed button in read_kpad_button()
652 sp->trig = change_fg & sp->hold ; // Pushed button in read_kpad_button()
653 sp->release = change_fg & old_fg ; // Released button in read_kpad_button()
765 KPADStatus *sp = &kp->status ; in calc_acc_vertical() local
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()
790 sp->acc_vertical.x = ax / f1 ; in calc_acc_vertical()
791 sp->acc_vertical.y = ay / f1 ; in calc_acc_vertical()
810 KPADStatus *sp = &kp->status ; in read_kpad_acc() local
834 vec = sp->acc ; in read_kpad_acc()
837 calc_acc( kp, &sp->acc.x, kp->hard_acc.x ) ; in read_kpad_acc()
838 calc_acc( kp, &sp->acc.y, kp->hard_acc.y ) ; in read_kpad_acc()
839 calc_acc( kp, &sp->acc.z, kp->hard_acc.z ) ; in read_kpad_acc()
840 sp->acc_value = sqrtf( sp->acc.x * sp->acc.x + sp->acc.y * sp->acc.y + sp->acc.z * sp->acc.z ) ; in read_kpad_acc()
843 vec.x -= sp->acc.x ; in read_kpad_acc()
844 vec.y -= sp->acc.y ; in read_kpad_acc()
845 vec.z -= sp->acc.z ; in read_kpad_acc()
846 sp->acc_speed = sqrtf( vec.x * vec.x + vec.y * vec.y + vec.z * vec.z ) ; in read_kpad_acc()
872 vec = sp->ex_status.fs.acc ; in read_kpad_acc()
875 calc_acc( kp, &sp->ex_status.fs.acc.x, fsrc.x ) ; in read_kpad_acc()
876 calc_acc( kp, &sp->ex_status.fs.acc.y, fsrc.y ) ; in read_kpad_acc()
877 calc_acc( kp, &sp->ex_status.fs.acc.z, fsrc.z ) ; in read_kpad_acc()
878 …sp->ex_status.fs.acc_value = sqrtf( sp->ex_status.fs.acc.x * sp->ex_status.fs.acc.x + sp->ex_statu… in read_kpad_acc()
881 vec.x -= sp->ex_status.fs.acc.x ; in read_kpad_acc()
882 vec.y -= sp->ex_status.fs.acc.y ; in read_kpad_acc()
883 vec.z -= sp->ex_status.fs.acc.z ; in read_kpad_acc()
884 sp->ex_status.fs.acc_speed = sqrtf( vec.x * vec.x + vec.y * vec.y + vec.z * vec.z ) ; in read_kpad_acc()
1263 KPADStatus *sp = &kp->status ; in calc_dpd_variable() local
1269 sp->dpd_valid_fg = 0 ; in calc_dpd_variable()
1281 if ( sp->dpd_valid_fg == 0 ) { in calc_dpd_variable()
1283 sp->horizon = pos ; in calc_dpd_variable()
1284 sp->hori_vec = Vec2_0 ; in calc_dpd_variable()
1285 sp->hori_speed = 0.0f ; in calc_dpd_variable()
1288 vec.x = pos.x - sp->horizon.x ; in calc_dpd_variable()
1289 vec.y = pos.y - sp->horizon.y ; 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()
1312 sp->hori_vec.x = vec.x - sp->horizon.x ; in calc_dpd_variable()
1313 sp->hori_vec.y = vec.y - sp->horizon.y ; in calc_dpd_variable()
1314 … sp->hori_speed = sqrtf( sp->hori_vec.x * sp->hori_vec.x + sp->hori_vec.y * sp->hori_vec.y ) ; in calc_dpd_variable()
1316 sp->horizon = vec ; 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()
1327 sp->hori_vec.x = vec.x - sp->horizon.x ; in calc_dpd_variable()
1328 sp->hori_vec.y = vec.y - sp->horizon.y ; in calc_dpd_variable()
1329 … sp->hori_speed = sqrtf( sp->hori_vec.x * sp->hori_vec.x + sp->hori_vec.y * sp->hori_vec.y ) ; in calc_dpd_variable()
1331 sp->horizon = vec ; in calc_dpd_variable()
1334 sp->hori_vec = Vec2_0 ; in calc_dpd_variable()
1335 sp->hori_speed = 0.0f ; in calc_dpd_variable()
1347 if ( sp->dpd_valid_fg == 0 ) { in calc_dpd_variable()
1349 sp->dist = dist ; in calc_dpd_variable()
1350 sp->dist_vec = 0.0f ; in calc_dpd_variable()
1351 sp->dist_speed = 0.0f ; in calc_dpd_variable()
1354 f2 = dist - sp->dist ; in calc_dpd_variable()
1375 sp->dist_vec = f1 * f2 ; in calc_dpd_variable()
1376 if ( sp->dist_vec < 0.0f ) { in calc_dpd_variable()
1377 sp->dist_speed = -sp->dist_vec ; in calc_dpd_variable()
1379 sp->dist_speed = sp->dist_vec ; in calc_dpd_variable()
1382 sp->dist += sp->dist_vec ; in calc_dpd_variable()
1387 sp->dist_vec = f1 * f2 ; in calc_dpd_variable()
1388 if ( sp->dist_vec < 0.0f ) { in calc_dpd_variable()
1389 sp->dist_speed = -sp->dist_vec ; in calc_dpd_variable()
1391 sp->dist_speed = sp->dist_vec ; in calc_dpd_variable()
1394 sp->dist += sp->dist_vec ; in calc_dpd_variable()
1397 sp->dist_vec = 0.0f ; in calc_dpd_variable()
1398 sp->dist_speed = 0.0f ; in calc_dpd_variable()
1425 if ( sp->dpd_valid_fg == 0 ) { in calc_dpd_variable()
1427 sp->pos = pos ; in calc_dpd_variable()
1428 sp->vec = Vec2_0 ; in calc_dpd_variable()
1429 sp->speed = 0.0f ; in calc_dpd_variable()
1432 vec.x = pos.x - sp->pos.x ; in calc_dpd_variable()
1433 vec.y = pos.y - sp->pos.y ; 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()
1452 sp->speed = sqrtf( sp->vec.x * sp->vec.x + sp->vec.y * sp->vec.y ) ; in calc_dpd_variable()
1454 sp->pos.x += sp->vec.x ; in calc_dpd_variable()
1455 sp->pos.y += sp->vec.y ; 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()
1462 sp->speed = sqrtf( sp->vec.x * sp->vec.x + sp->vec.y * sp->vec.y ) ; in calc_dpd_variable()
1464 sp->pos.x += sp->vec.x ; in calc_dpd_variable()
1465 sp->pos.y += sp->vec.y ; in calc_dpd_variable()
1468 sp->vec = Vec2_0 ; in calc_dpd_variable()
1469 sp->speed = 0.0f ; in calc_dpd_variable()
1477 sp->dpd_valid_fg = valid_fg_next ; in calc_dpd_variable()
1486 KPADStatus *sp = &kp->status ; in read_kpad_dpd() local
1521 if ( sp->acc_vertical.x <= kp_err_up_inpr ) goto LABEL_select_NG ; in read_kpad_dpd()
1523 if ( sp->dpd_valid_fg == 2 || sp->dpd_valid_fg == -2 ) { in read_kpad_dpd()
1535 } else if ( sp->dpd_valid_fg == 1 || sp->dpd_valid_fg == -1 ) { in read_kpad_dpd()
1584 if ( sp->dpd_valid_fg == 2 && valid_fg_next == 2 ) { in read_kpad_dpd()