Lines Matching refs:sp
234 KPADStatus *sp = &kp->status ; in reset_kpad() local
235 KPADEXStatus *ep = &sp->ex_status ; in reset_kpad()
239 sp->hold = sp->trig = sp->release = 0x00000000 ; in reset_kpad()
244 sp->dpd_valid_fg = 0 ; // Invalid in reset_kpad()
247 sp->pos = sp->vec = Vec2_0 ; in reset_kpad()
248 sp->speed = 0.0f ; in reset_kpad()
250 sp->horizon.x = kp->acc_horizon.x = kp->obj_horizon.x = 1.0f ; in reset_kpad()
251 sp->horizon.y = kp->acc_horizon.y = kp->obj_horizon.y = 0.0f ; in reset_kpad()
252 sp->hori_vec = Vec2_0 ; in reset_kpad()
253 sp->hori_speed = 0.0f ; in reset_kpad()
255 sp->acc_vertical.x = 1.0f ; in reset_kpad()
256 sp->acc_vertical.y = 0.0f ; in reset_kpad()
258 sp->dist = kp->dist_org ; in reset_kpad()
259 sp->dist_vec = sp->dist_speed = 0.0f ; in reset_kpad()
261 kp->sec_dist = sp->dist ; in reset_kpad()
266 sp->acc.x = sp->acc.z = 0.0f ; in reset_kpad()
267 sp->acc.y = -1.0f ; in reset_kpad()
268 sp->acc_value = 1.0f ; in reset_kpad()
269 sp->acc_speed = 0.0f ; in reset_kpad()
270 kp->hard_acc = sp->acc ; in reset_kpad()
292 sp->wpad_err = WPAD_ERR_NONE ; // Since there is no error for the time being in reset_kpad()
301 switch( sp->dev_type ) { in reset_kpad()
332 KPADStatus *sp = &kp->status ; in KPADCalibrateDPD() local
394 sp->dpd_valid_fg = 0 ; // Invalid for the time being in KPADCalibrateDPD()
445 static void calc_button_repeat( KPADInsideStatus *kp, KPADStatus *sp, u32 dev_type ) in calc_button_repeat() argument
448 if ( sp->ex_status.cl.trig != 0 || sp->ex_status.cl.release != 0 ) { in calc_button_repeat()
454 if ( sp->ex_status.cl.trig && kp->btn_cl_repeat_pulse ) { in calc_button_repeat()
455 sp->ex_status.cl.hold |= KPAD_BUTTON_RPT ; in calc_button_repeat()
457 } else if ( sp->ex_status.cl.hold != 0 ) { in calc_button_repeat()
466 sp->ex_status.cl.hold |= KPAD_BUTTON_RPT ; in calc_button_repeat()
479 if ( sp->trig != 0 || sp->release != 0 ) { in calc_button_repeat()
485 if ( sp->trig && kp->btn_repeat_pulse ) { in calc_button_repeat()
486 sp->hold |= KPAD_BUTTON_RPT ; in calc_button_repeat()
489 } else if ( sp->hold != 0 ) { in calc_button_repeat()
498 sp->hold |= KPAD_BUTTON_RPT ; in calc_button_repeat()
519 KPADStatus *sp = &kp->status ; in read_kpad_button() local
531 old_fg = sp->hold & KPAD_BUTTON_MASK ; in read_kpad_button()
551 sp->hold = (u32)fp->button ; in read_kpad_button()
566 sp->hold = (u32)cp->button ; in read_kpad_button()
582 sp->hold = (u32)wp->button ; in read_kpad_button()
587 change_fg = sp->hold ^ old_fg ; // Change button in read_kpad_button()
588 sp->trig = change_fg & sp->hold ; // Held button in read_kpad_button()
589 sp->release = change_fg & old_fg ; // Released button in read_kpad_button()
592 calc_button_repeat( kp, sp, WPAD_DEV_CORE ) ; in read_kpad_button()
600 calc_button_repeat( kp, sp, WPAD_DEV_CLASSIC ); in read_kpad_button()
689 KPADStatus *sp = &kp->status ; in calc_acc_vertical() local
708 ax = ( ax - sp->acc_vertical.x ) * f1 + sp->acc_vertical.x ; in calc_acc_vertical()
709 ay = ( ay - sp->acc_vertical.y ) * f1 + sp->acc_vertical.y ; in calc_acc_vertical()
714 sp->acc_vertical.x = ax / f1 ; in calc_acc_vertical()
715 sp->acc_vertical.y = ay / f1 ; in calc_acc_vertical()
734 KPADStatus *sp = &kp->status ; in read_kpad_acc() local
809 vec = sp->acc ; in read_kpad_acc()
812 calc_acc( kp, &sp->acc.x, kp->hard_acc.x ) ; in read_kpad_acc()
813 calc_acc( kp, &sp->acc.y, kp->hard_acc.y ) ; in read_kpad_acc()
814 calc_acc( kp, &sp->acc.z, kp->hard_acc.z ) ; in read_kpad_acc()
815 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()
818 vec.x -= sp->acc.x ; in read_kpad_acc()
819 vec.y -= sp->acc.y ; in read_kpad_acc()
820 vec.z -= sp->acc.z ; in read_kpad_acc()
821 sp->acc_speed = sqrtf( vec.x * vec.x + vec.y * vec.y + vec.z * vec.z ) ; in read_kpad_acc()
834 vec = sp->ex_status.fs.acc ; in read_kpad_acc()
837 …calc_acc( kp, &sp->ex_status.fs.acc.x, clamp_acc( (f32)(s32)-fp->fsAccX * fs_acc_scale_x, kp_fs_ac… in read_kpad_acc()
838 …calc_acc( kp, &sp->ex_status.fs.acc.y, clamp_acc( (f32)(s32)-fp->fsAccZ * fs_acc_scale_z, kp_fs_ac… in read_kpad_acc()
839 …calc_acc( kp, &sp->ex_status.fs.acc.z, clamp_acc( (f32)(s32) fp->fsAccY * fs_acc_scale_y, kp_fs_ac… in read_kpad_acc()
840 …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()
843 vec.x -= sp->ex_status.fs.acc.x ; in read_kpad_acc()
844 vec.y -= sp->ex_status.fs.acc.y ; in read_kpad_acc()
845 vec.z -= sp->ex_status.fs.acc.z ; in read_kpad_acc()
846 sp->ex_status.fs.acc_speed = sqrtf( vec.x * vec.x + vec.y * vec.y + vec.z * vec.z ) ; in read_kpad_acc()
1234 KPADStatus *sp = &kp->status ; in calc_dpd_variable() local
1240 sp->dpd_valid_fg = 0 ; in calc_dpd_variable()
1252 if ( sp->dpd_valid_fg == 0 ) { in calc_dpd_variable()
1254 sp->horizon = pos ; in calc_dpd_variable()
1255 sp->hori_vec = Vec2_0 ; in calc_dpd_variable()
1256 sp->hori_speed = 0.0f ; in calc_dpd_variable()
1259 vec.x = pos.x - sp->horizon.x ; in calc_dpd_variable()
1260 vec.y = pos.y - sp->horizon.y ; in calc_dpd_variable()
1276 vec.x = f1 * vec.x + sp->horizon.x ; in calc_dpd_variable()
1277 vec.y = f1 * vec.y + sp->horizon.y ; in calc_dpd_variable()
1282 sp->hori_vec.x = vec.x - sp->horizon.x ; in calc_dpd_variable()
1283 sp->hori_vec.y = vec.y - sp->horizon.y ; in calc_dpd_variable()
1284 … sp->hori_speed = sqrtf( sp->hori_vec.x * sp->hori_vec.x + sp->hori_vec.y * sp->hori_vec.y ) ; in calc_dpd_variable()
1286 sp->horizon = vec ; in calc_dpd_variable()
1296 if ( sp->dpd_valid_fg == 0 ) { in calc_dpd_variable()
1298 sp->dist = dist ; in calc_dpd_variable()
1299 sp->dist_vec = 0.0f ; in calc_dpd_variable()
1300 sp->dist_speed = 0.0f ; in calc_dpd_variable()
1303 f2 = dist - sp->dist ; in calc_dpd_variable()
1323 sp->dist_vec = f1 * f2 ; in calc_dpd_variable()
1324 if ( sp->dist_vec < 0.0f ) { in calc_dpd_variable()
1325 sp->dist_speed = -sp->dist_vec ; in calc_dpd_variable()
1327 sp->dist_speed = sp->dist_vec ; in calc_dpd_variable()
1330 sp->dist += sp->dist_vec ; in calc_dpd_variable()
1355 if ( sp->dpd_valid_fg == 0 ) { in calc_dpd_variable()
1357 sp->pos = pos ; in calc_dpd_variable()
1358 sp->vec = Vec2_0 ; in calc_dpd_variable()
1359 sp->speed = 0.0f ; in calc_dpd_variable()
1362 vec.x = pos.x - sp->pos.x ; in calc_dpd_variable()
1363 vec.y = pos.y - sp->pos.y ; in calc_dpd_variable()
1379 sp->vec.x = f1 * vec.x ; in calc_dpd_variable()
1380 sp->vec.y = f1 * vec.y ; in calc_dpd_variable()
1381 sp->speed = sqrtf( sp->vec.x * sp->vec.x + sp->vec.y * sp->vec.y ) ; in calc_dpd_variable()
1383 sp->pos.x += sp->vec.x ; in calc_dpd_variable()
1384 sp->pos.y += sp->vec.y ; in calc_dpd_variable()
1390 sp->dpd_valid_fg = valid_fg_next ; in calc_dpd_variable()
1399 KPADStatus *sp = &kp->status ; in read_kpad_dpd() local
1475 if ( sp->acc_vertical.x <= kp_err_up_inpr ) goto LABEL_select_NG ; in read_kpad_dpd()
1477 if ( sp->dpd_valid_fg == 2 || sp->dpd_valid_fg == -2 ) { in read_kpad_dpd()
1489 } else if ( sp->dpd_valid_fg == 1 || sp->dpd_valid_fg == -1 ) { in read_kpad_dpd()
1538 if ( sp->dpd_valid_fg == 2 && valid_fg_next == 2 ) { in read_kpad_dpd()
1638 KPADStatus *sp = &kp->status ; in read_kpad_stick() local
1645 if ( sp->dev_type == WPAD_DEV_FREESTYLE ) { in read_kpad_stick()
1658 …clamp_stick( &sp->ex_status.fs.stick, fp->fsStickX, fp->fsStickY, kp_fs_fstick_min, kp_fs_fstick_m… in read_kpad_stick()
1659 } else if ( sp->dev_type == WPAD_DEV_CLASSIC ) { in read_kpad_stick()
1672 …clamp_stick( &sp->ex_status.cl.lstick, cp->clLStickX, cp->clLStickY, kp_cl_stick_min, kp_cl_stick_… in read_kpad_stick()
1673 …clamp_stick( &sp->ex_status.cl.rstick, cp->clRStickX, cp->clRStickY, kp_cl_stick_min, kp_cl_stick_… in read_kpad_stick()
1674 …clamp_trigger( &sp->ex_status.cl.ltrigger, cp->clTriggerL, kp_cl_trigger_min, kp_cl_trigger_max ) ; in read_kpad_stick()
1675 …clamp_trigger( &sp->ex_status.cl.rtrigger, cp->clTriggerR, kp_cl_trigger_min, kp_cl_trigger_max ) ; in read_kpad_stick()
1759 KPADStatus *sp ; in KPADRead() local
1771 sp = &samplingBufs[ length - 1 ] ; in KPADRead()
1773 sp->dev_type = kp->status.dev_type ; in KPADRead()
1774 } while ( --sp >= samplingBufs ) ; in KPADRead()
1830 sp = &samplingBufs[ copy_ct ] ; // Continue saving with old data at the rear in KPADRead()
1848 -- sp ; // Backup storage buffer in KPADRead()
1849 *sp = kp->status ; // Actually, button data is copied unnecessarily in KPADRead()
1868 -- sp ; // Backup storage buffer in KPADRead()
1869 *sp = kp->status ; // Actually, button data is copied unnecessarily in KPADRead()
1888 -- sp ; // Backup storage buffer in KPADRead()
1889 *sp = kp->status ; // Actually, button data is copied unnecessarily in KPADRead()
1910 sp->hold = kp->status.hold ; in KPADRead()
1911 sp->trig = kp->status.trig ; in KPADRead()
1912 sp->release = kp->status.release ; in KPADRead()
1913 ++ sp ; // Proceed forward because we're at the start of the storage buffer in KPADRead()
1916 sp->ex_status.cl.hold = kp->status.ex_status.cl.hold; in KPADRead()
1917 sp->ex_status.cl.trig = kp->status.ex_status.cl.trig; in KPADRead()
1918 sp->ex_status.cl.release = kp->status.ex_status.cl.release; in KPADRead()