Searched refs:delta_T (Results 1 – 1 of 1) sorted by relevance
23 float delta_T = (float)(in->time - in->last_time) / 1000; // now seconds in range_kalman() local24 float delta_T2 = delta_T * delta_T; in range_kalman()25 float delta_T3 = delta_T2 * delta_T; in range_kalman()30 range_hat = in->last_range + delta_T * in->last_range_rate; in range_kalman()36 R1_11 = in->R0_11 + delta_T * 2 * in->R0_12 + delta_T2 * in->R0_22; in range_kalman()37 R1_12 = in->R0_12 + delta_T * in->R0_22; in range_kalman()43 R1_22 += in->drive_var * delta_T; in range_kalman()66 (double)sqrtf(in->R0_22), (int)(delta_T * 1000), (double)in->last_range_rate); in range_kalman()97 unsigned int delta_T = in->time - in->last_time; // format ?? in range_kalman() local98 unsigned int delta_T2 = delta_T * delta_T; in range_kalman()[all …]
