Lines Matching refs:sp
391 KPADStatus *sp = &kp->status ; in reset_kpad() local
410 sp->hold = sp->trig = sp->release = 0x00000000 ; in reset_kpad()
415 sp->dpd_valid_fg = 0 ; // Disabled in reset_kpad()
418 sp->pos = sp->vec = Vec2_0 ; in reset_kpad()
419 sp->speed = 0.0f ; in reset_kpad()
421 sp->horizon.x = kp->acc_horizon.x = kp->obj_horizon.x = 1.0f ; in reset_kpad()
422 sp->horizon.y = kp->acc_horizon.y = kp->obj_horizon.y = 0.0f ; in reset_kpad()
423 sp->hori_vec = Vec2_0 ; in reset_kpad()
424 sp->hori_speed = 0.0f ; in reset_kpad()
426 sp->acc_vertical.x = 1.0f ; in reset_kpad()
427 sp->acc_vertical.y = 0.0f ; in reset_kpad()
429 sp->dist = kp->dist_org ; in reset_kpad()
430 sp->dist_vec = sp->dist_speed = 0.0f ; in reset_kpad()
432 kp->sec_dist = sp->dist ; in reset_kpad()
437 sp->acc.x = sp->acc.z = 0.0f ; in reset_kpad()
438 sp->acc.y = -1.0f ; in reset_kpad()
439 sp->acc_value = 1.0f ; in reset_kpad()
440 sp->acc_speed = 0.0f ; in reset_kpad()
441 kp->hard_acc = sp->acc ; in reset_kpad()
488 KPADStatus *sp = &kp->status ; in KPADCalibrateDPD() local
550 sp->dpd_valid_fg = 0 ; // Invalid for now in KPADCalibrateDPD()
596 KPADStatus *sp = &kp->status ; in calc_button_repeat() local
599 if ( sp->trig != 0 || sp->release != 0 ) { in calc_button_repeat()
605 if ( sp->trig && kp->btn_repeat_pulse ) { in calc_button_repeat()
606 sp->hold |= KPAD_BUTTON_RPT ; in calc_button_repeat()
608 } else if ( sp->hold != 0 ) { in calc_button_repeat()
617 sp->hold |= KPAD_BUTTON_RPT ; in calc_button_repeat()
672 KPADStatus *sp = &kp->status ; in read_kpad_button() local
679 old_fg = sp->hold & KPAD_BUTTON_MASK ; in read_kpad_button()
682 sp->hold = ( core & (KPAD_BUTTON_MASK & ~(WPAD_BUTTON_Z | WPAD_BUTTON_C)) ) ; in read_kpad_button()
691 sp->hold |= ( ex & (WPAD_BUTTON_Z | WPAD_BUTTON_C) ) ; in read_kpad_button()
695 change_fg = sp->hold ^ old_fg ; // Changed button in read_kpad_button()
696 sp->trig = change_fg & sp->hold ; // Pressed button in read_kpad_button()
697 sp->release = change_fg & old_fg ; // Released button in read_kpad_button()
818 KPADStatus *sp = &kp->status ; in calc_acc_vertical() local
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()
843 sp->acc_vertical.x = ax / f1 ; in calc_acc_vertical()
844 sp->acc_vertical.y = ay / f1 ; in calc_acc_vertical()
863 KPADStatus *sp = &kp->status ; in read_kpad_acc() local
888 vec = sp->acc ; in read_kpad_acc()
891 calc_acc( kp, &sp->acc.x, kp->hard_acc.x ) ; in read_kpad_acc()
892 calc_acc( kp, &sp->acc.y, kp->hard_acc.y ) ; in read_kpad_acc()
893 calc_acc( kp, &sp->acc.z, kp->hard_acc.z ) ; in read_kpad_acc()
894 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()
897 vec.x -= sp->acc.x ; in read_kpad_acc()
898 vec.y -= sp->acc.y ; in read_kpad_acc()
899 vec.z -= sp->acc.z ; in read_kpad_acc()
900 sp->acc_speed = sqrtf( vec.x * vec.x + vec.y * vec.y + vec.z * vec.z ) ; in read_kpad_acc()
926 vec = sp->ex_status.fs.acc ; in read_kpad_acc()
929 calc_acc( kp, &sp->ex_status.fs.acc.x, fsrc.x ) ; in read_kpad_acc()
930 calc_acc( kp, &sp->ex_status.fs.acc.y, fsrc.y ) ; in read_kpad_acc()
931 calc_acc( kp, &sp->ex_status.fs.acc.z, fsrc.z ) ; in read_kpad_acc()
932 …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()
935 vec.x -= sp->ex_status.fs.acc.x ; in read_kpad_acc()
936 vec.y -= sp->ex_status.fs.acc.y ; in read_kpad_acc()
937 vec.z -= sp->ex_status.fs.acc.z ; in read_kpad_acc()
938 sp->ex_status.fs.acc_speed = sqrtf( vec.x * vec.x + vec.y * vec.y + vec.z * vec.z ) ; in read_kpad_acc()
1317 KPADStatus *sp = &kp->status ; in calc_dpd_variable() local
1323 sp->dpd_valid_fg = 0 ; in calc_dpd_variable()
1335 if ( sp->dpd_valid_fg == 0 ) { in calc_dpd_variable()
1337 sp->horizon = pos ; in calc_dpd_variable()
1338 sp->hori_vec = Vec2_0 ; in calc_dpd_variable()
1339 sp->hori_speed = 0.0f ; in calc_dpd_variable()
1342 vec.x = pos.x - sp->horizon.x ; in calc_dpd_variable()
1343 vec.y = pos.y - sp->horizon.y ; 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()
1366 sp->hori_vec.x = vec.x - sp->horizon.x ; in calc_dpd_variable()
1367 sp->hori_vec.y = vec.y - sp->horizon.y ; in calc_dpd_variable()
1368 … sp->hori_speed = sqrtf( sp->hori_vec.x * sp->hori_vec.x + sp->hori_vec.y * sp->hori_vec.y ) ; in calc_dpd_variable()
1370 sp->horizon = vec ; 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()
1381 sp->hori_vec.x = vec.x - sp->horizon.x ; in calc_dpd_variable()
1382 sp->hori_vec.y = vec.y - sp->horizon.y ; in calc_dpd_variable()
1383 … sp->hori_speed = sqrtf( sp->hori_vec.x * sp->hori_vec.x + sp->hori_vec.y * sp->hori_vec.y ) ; in calc_dpd_variable()
1385 sp->horizon = vec ; in calc_dpd_variable()
1388 sp->hori_vec = Vec2_0 ; in calc_dpd_variable()
1389 sp->hori_speed = 0.0f ; in calc_dpd_variable()
1401 if ( sp->dpd_valid_fg == 0 ) { in calc_dpd_variable()
1403 sp->dist = dist ; in calc_dpd_variable()
1404 sp->dist_vec = 0.0f ; in calc_dpd_variable()
1405 sp->dist_speed = 0.0f ; in calc_dpd_variable()
1408 f2 = dist - sp->dist ; in calc_dpd_variable()
1429 sp->dist_vec = f1 * f2 ; in calc_dpd_variable()
1430 if ( sp->dist_vec < 0.0f ) { in calc_dpd_variable()
1431 sp->dist_speed = -sp->dist_vec ; in calc_dpd_variable()
1433 sp->dist_speed = sp->dist_vec ; in calc_dpd_variable()
1436 sp->dist += sp->dist_vec ; in calc_dpd_variable()
1441 sp->dist_vec = f1 * f2 ; in calc_dpd_variable()
1442 if ( sp->dist_vec < 0.0f ) { in calc_dpd_variable()
1443 sp->dist_speed = -sp->dist_vec ; in calc_dpd_variable()
1445 sp->dist_speed = sp->dist_vec ; in calc_dpd_variable()
1448 sp->dist += sp->dist_vec ; in calc_dpd_variable()
1451 sp->dist_vec = 0.0f ; in calc_dpd_variable()
1452 sp->dist_speed = 0.0f ; in calc_dpd_variable()
1479 if ( sp->dpd_valid_fg == 0 ) { in calc_dpd_variable()
1481 sp->pos = pos ; in calc_dpd_variable()
1482 sp->vec = Vec2_0 ; in calc_dpd_variable()
1483 sp->speed = 0.0f ; in calc_dpd_variable()
1486 vec.x = pos.x - sp->pos.x ; in calc_dpd_variable()
1487 vec.y = pos.y - sp->pos.y ; 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()
1506 sp->speed = sqrtf( sp->vec.x * sp->vec.x + sp->vec.y * sp->vec.y ) ; in calc_dpd_variable()
1508 sp->pos.x += sp->vec.x ; in calc_dpd_variable()
1509 sp->pos.y += sp->vec.y ; 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()
1516 sp->speed = sqrtf( sp->vec.x * sp->vec.x + sp->vec.y * sp->vec.y ) ; in calc_dpd_variable()
1518 sp->pos.x += sp->vec.x ; in calc_dpd_variable()
1519 sp->pos.y += sp->vec.y ; in calc_dpd_variable()
1522 sp->vec = Vec2_0 ; in calc_dpd_variable()
1523 sp->speed = 0.0f ; in calc_dpd_variable()
1531 sp->dpd_valid_fg = valid_fg_next ; in calc_dpd_variable()
1540 KPADStatus *sp = &kp->status ; in read_kpad_dpd() local
1576 if ( sp->acc_vertical.x <= kp_err_up_inpr ) goto LABEL_select_NG ; in read_kpad_dpd()
1578 if ( sp->dpd_valid_fg == 2 || sp->dpd_valid_fg == -2 ) { in read_kpad_dpd()
1590 } else if ( sp->dpd_valid_fg == 1 || sp->dpd_valid_fg == -1 ) { in read_kpad_dpd()
1639 if ( sp->dpd_valid_fg == 2 && valid_fg_next == 2 ) { in read_kpad_dpd()