mirrors/monado
1
0
Fork 0
mirror of https://gitlab.freedesktop.org/monado/monado.git synced 2025-01-01 04:36:07 +00:00
Code Issues Actions Packages Projects Releases Wiki Activity

m/ff: Improve interface

Browse source
This commit is contained in:
Jakob Bornecrantz 2020-09-16 17:26:13 +01:00
parent 71f912ffc5
commit 6a94b1cf80
2 changed files with 40 additions and 4 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

28
src/xrt/auxiliary/math/m_filter_fifo.c
View file

@ -88,6 +88,12 @@ m_ff_vec3_f32_free(struct m_ff_vec3_f32 **ff_ptr)
*ff_ptr = NULL; *ff_ptr = NULL;
} }
size_t
m_ff_vec3_f32_get_num(struct m_ff_vec3_f32 *ff)
{
return ff->num;
}
void void
m_ff_vec3_f32_push(struct m_ff_vec3_f32 *ff, m_ff_vec3_f32_push(struct m_ff_vec3_f32 *ff,
const struct xrt_vec3 *sample, const struct xrt_vec3 *sample,
@ -103,15 +109,21 @@ m_ff_vec3_f32_push(struct m_ff_vec3_f32 *ff,
ff->timestamps_ns[i] = timestamp_ns; ff->timestamps_ns[i] = timestamp_ns;
} }
void bool
m_ff_vec3_f32_get(struct m_ff_vec3_f32 *ff, m_ff_vec3_f32_get(struct m_ff_vec3_f32 *ff,
size_t num, size_t num,
struct xrt_vec3 *out_sample, struct xrt_vec3 *out_sample,
uint64_t *out_timestamp_ns) uint64_t *out_timestamp_ns)
{ {
if (num >= ff->num) {
return false;
}
size_t pos = (ff->latest + num) % ff->num; size_t pos = (ff->latest + num) % ff->num;
*out_sample = ff->samples[pos]; *out_sample = ff->samples[pos];
*out_timestamp_ns = ff->timestamps_ns[pos]; *out_timestamp_ns = ff->timestamps_ns[pos];
return true;
} }
size_t size_t
@ -242,6 +254,12 @@ m_ff_f64_free(struct m_ff_f64 **ff_ptr)
*ff_ptr = NULL; *ff_ptr = NULL;
} }
size_t
m_ff_f64_get_num(struct m_ff_f64 *ff)
{
return ff->num;
}
void void
m_ff_f64_push(struct m_ff_f64 *ff, const double *sample, uint64_t timestamp_ns) m_ff_f64_push(struct m_ff_f64 *ff, const double *sample, uint64_t timestamp_ns)
{ {
@ -255,15 +273,21 @@ m_ff_f64_push(struct m_ff_f64 *ff, const double *sample, uint64_t timestamp_ns)
ff->timestamps_ns[i] = timestamp_ns; ff->timestamps_ns[i] = timestamp_ns;
} }
void bool
m_ff_f64_get(struct m_ff_f64 *ff, m_ff_f64_get(struct m_ff_f64 *ff,
size_t num, size_t num,
double *out_sample, double *out_sample,
uint64_t *out_timestamp_ns) uint64_t *out_timestamp_ns)
{ {
if (num >= ff->num) {
return false;
}
size_t pos = (ff->latest + num) % ff->num; size_t pos = (ff->latest + num) % ff->num;
*out_sample = ff->samples[pos]; *out_sample = ff->samples[pos];
*out_timestamp_ns = ff->timestamps_ns[pos]; *out_timestamp_ns = ff->timestamps_ns[pos];
return true;
} }
size_t size_t

16
src/xrt/auxiliary/math/m_filter_fifo.h
View file

@ -32,6 +32,12 @@ m_ff_vec3_f32_alloc(struct m_ff_vec3_f32 **ff_out, size_t num);
void void
m_ff_vec3_f32_free(struct m_ff_vec3_f32 **ff_ptr); m_ff_vec3_f32_free(struct m_ff_vec3_f32 **ff_ptr);
/*!
* Return the number of samples that can fill the fifo.
*/
size_t
m_ff_vec3_f32_get_num(struct m_ff_vec3_f32 *ff);
/*! /*!
* Pushes a sample at the given timepoint, pushing samples out of order yields * Pushes a sample at the given timepoint, pushing samples out of order yields
* unspecified behaviour, so samples must be pushed in time order. * unspecified behaviour, so samples must be pushed in time order.
@ -45,7 +51,7 @@ m_ff_vec3_f32_push(struct m_ff_vec3_f32 *ff,
* Return the sample at the index, zero means the last sample push, one second * Return the sample at the index, zero means the last sample push, one second
* last and so on. * last and so on.
*/ */
void bool
m_ff_vec3_f32_get(struct m_ff_vec3_f32 *ff, m_ff_vec3_f32_get(struct m_ff_vec3_f32 *ff,
size_t num, size_t num,
struct xrt_vec3 *out_sample, struct xrt_vec3 *out_sample,
@ -82,6 +88,12 @@ m_ff_f64_alloc(struct m_ff_f64 **ff_out, size_t num);
void void
m_ff_f64_free(struct m_ff_f64 **ff_ptr); m_ff_f64_free(struct m_ff_f64 **ff_ptr);
/*!
* Return the number of samples that can fill the fifo.
*/
size_t
m_ff_f64_get_num(struct m_ff_f64 *ff);
/*! /*!
* Pushes a sample at the given timepoint, pushing samples out of order yields * Pushes a sample at the given timepoint, pushing samples out of order yields
* unspecified behaviour, so samples must be pushed in time order. * unspecified behaviour, so samples must be pushed in time order.
@ -93,7 +105,7 @@ m_ff_f64_push(struct m_ff_f64 *ff, const double *sample, uint64_t timestamp_ns);
* Return the sample at the index, zero means the last sample push, one second * Return the sample at the index, zero means the last sample push, one second
* last and so on. * last and so on.
*/ */
void bool
m_ff_f64_get(struct m_ff_f64 *ff, m_ff_f64_get(struct m_ff_f64 *ff,
size_t num, size_t num,
double *out_sample, double *out_sample,