Вот код, который делает floor / ceil на предварительно SSE4.1 CPU. Обратите внимание, что использование '-ffast-math' сломает его!
#include <cmath>
#include <emmintrin.h>
#include <cstdio> // for printf
#ifdef _MSC_VER
#define __attribute__(P)
#endif
struct vec2d {
double x;
double y;
};
static __m128d mm_blendv_pd(const __m128d& a, const __m128d& b, const __m128d& mask) noexcept {
return _mm_or_pd(_mm_andnot_pd(mask, a), _mm_and_pd(b, mask));
}
__attribute__((optimize("-fno-associative-math")))
vec2d _floor(vec2d v) noexcept {
__m128d src = _mm_set_pd(v.x, v.y);
__m128d maxn = _mm_set_pd(4503599627370496.0, 4503599627370496.0); // pow(2, 52)
__m128d magic = _mm_set_pd(6755399441055744.0, 6755399441055744.0); // pow(2, 52) + pow(2, 51)
__m128d msk = _mm_cmpnlt_pd(src, maxn);
__m128d rounded = _mm_sub_pd(_mm_add_pd(src, magic), magic); //! -ffast-math will break this!
__m128d maybeone = _mm_and_pd(_mm_cmplt_pd(src, rounded), _mm_set_pd(1.0, 1.0));
__m128d res = mm_blendv_pd(_mm_sub_pd(rounded, maybeone), src, msk);
return {_mm_cvtsd_f64(_mm_unpackhi_pd(res, res)), _mm_cvtsd_f64(res)};
}
__attribute__((optimize("-fno-associative-math")))
vec2d _ceil(vec2d v) noexcept {
__m128d src = _mm_set_pd(v.x, v.y);
__m128d maxn = _mm_set_pd(4503599627370496.0, 4503599627370496.0); // pow(2, 52)
__m128d magic = _mm_set_pd(6755399441055744.0, 6755399441055744.0); // pow(2, 52) + pow(2, 51)
__m128d msk = _mm_cmpnlt_pd(src, maxn);
__m128d rounded = _mm_sub_pd(_mm_add_pd(src, magic), magic); //! -ffast-math will break this!
__m128d maybeone = _mm_and_pd(_mm_cmpnle_pd(src, rounded), _mm_set_pd(1.0, 1.0));
__m128d res = mm_blendv_pd(_mm_add_pd(rounded, maybeone), src, msk);
return {_mm_cvtsd_f64(_mm_unpackhi_pd(res, res)), _mm_cvtsd_f64(res)};
}
int main() {
vec2d v{3.1,4.6};
vec2d v2 = _floor(v);
vec2d v3 = _ceil(v);
printf(" v2: %f %f\n",v2.x,v2.y);
printf(" v3: %f %f\n",v3.x,v3.y);
return 0;
}
Живой код
Он основан на этом сообщении в блоге Компиляторы C ++ и FP Округление на X86 , но в коде есть ошибки.