}\r
\r
audio_buffer mix()\r
- {\r
- auto result = audio_buffer(format_desc_.audio_samples_per_frame, 0);\r
+ { \r
+ // NOTE: auto data should be larger than format_desc_.audio_samples_per_frame to allow sse to read/write beyond size.\r
+\r
+ auto intermediate = std::vector<float, tbb::cache_aligned_allocator<float>>(format_desc_.audio_samples_per_frame+128, 0.0f);\r
\r
std::map<const void*, core::frame_transform> next_frame_transforms;\r
+ \r
+ tbb::affinity_partitioner ap;\r
\r
BOOST_FOREACH(auto& item, items)\r
- { \r
+ { \r
const auto next = item.transform;\r
auto prev = next;\r
\r
\r
const float prev_volume = static_cast<float>(prev.volume);\r
const float next_volume = static_cast<float>(next.volume);\r
- const float delta = 1.0f/static_cast<float>(format_desc_.audio_samples_per_frame/2);\r
+ const float delta = 1.0f/static_cast<float>(format_desc_.audio_samples_per_frame/format_desc_.audio_channels);\r
\r
tbb::parallel_for\r
(\r
tbb::blocked_range<size_t>(0, format_desc_.audio_samples_per_frame/4),\r
[&](const tbb::blocked_range<size_t>& r)\r
- {\r
- for(size_t n = r.begin(); n < r.end(); ++n)\r
- {\r
- const float alpha0 = (n*2) * delta;\r
- const float volume0 = prev_volume * (1.0f - alpha0) + next_volume * alpha0;\r
- const float volume1 = prev_volume * (1.0f - alpha0 + delta) + next_volume * (alpha0 + delta);\r
+ { \r
+ auto alpha_ps = _mm_setr_ps(delta, delta, 0.0f, 0.0f);\r
+ auto delta2_ps = _mm_set_ps1(delta*2.0f);\r
+ auto prev_ps = _mm_set_ps1(prev_volume);\r
+ auto next_ps = _mm_set_ps1(next_volume); \r
\r
- auto sample_epi32 = _mm_load_si128(reinterpret_cast<__m128i*>(&item.audio_data[n*4]));\r
+ for(size_t n = r.begin(); n < r.end(); ++n)\r
+ { \r
+ auto next2_ps = _mm_mul_ps(next_ps, alpha_ps);\r
+ auto prev2_ps = _mm_sub_ps(prev_ps, _mm_mul_ps(prev_ps, alpha_ps));\r
+ auto volume_ps = _mm_add_ps(next2_ps, prev2_ps);\r
\r
- auto sample_ps = _mm_cvtepi32_ps(sample_epi32); \r
- sample_ps = _mm_mul_ps(sample_ps, _mm_setr_ps(volume1, volume1, volume0, volume0)); \r
+ auto sample_ps = _mm_cvtepi32_ps(_mm_load_si128(reinterpret_cast<__m128i*>(&item.audio_data[n*4])));\r
+ auto res_sample_ps = _mm_load_ps(&intermediate[n*4]); \r
+ sample_ps = _mm_mul_ps(sample_ps, volume_ps); \r
+ res_sample_ps = _mm_add_ps(sample_ps, res_sample_ps); \r
\r
- auto res_sample_epi32 = _mm_load_si128(reinterpret_cast<__m128i*>(&result[n*4]));\r
- auto res_sample_ps = _mm_cvtepi32_ps(res_sample_epi32); \r
+ alpha_ps = _mm_add_ps(alpha_ps, delta2_ps);\r
\r
- res_sample_ps = _mm_add_ps(sample_ps, res_sample_ps);\r
- res_sample_epi32 = _mm_cvtps_epi32(res_sample_ps);\r
- \r
- _mm_store_si128(reinterpret_cast<__m128i*>(&result[n*4]), res_sample_epi32);\r
+ _mm_store_ps(&intermediate[n*4], res_sample_ps);\r
}\r
}\r
- );\r
+ , ap);\r
}\r
+ \r
+ auto result = audio_buffer(format_desc_.audio_samples_per_frame+128, 0); \r
+ \r
+ tbb::parallel_for\r
+ (\r
+ tbb::blocked_range<size_t>(0, format_desc_.audio_samples_per_frame/32),\r
+ [&](const tbb::blocked_range<size_t>& r)\r
+ { \r
+ auto intermediate_128 = reinterpret_cast<__m128i*>(intermediate.data()+r.begin()*32);\r
+ auto result_128 = reinterpret_cast<__m128i*>(result.data()+r.begin()*32);\r
+ \r
+ for(size_t n = r.begin(); n < r.end(); ++n)\r
+ { \r
+ auto xmm0 = _mm_load_ps(reinterpret_cast<float*>(intermediate_128++));\r
+ auto xmm1 = _mm_load_ps(reinterpret_cast<float*>(intermediate_128++));\r
+ auto xmm2 = _mm_load_ps(reinterpret_cast<float*>(intermediate_128++));\r
+ auto xmm3 = _mm_load_ps(reinterpret_cast<float*>(intermediate_128++));\r
+ auto xmm4 = _mm_load_ps(reinterpret_cast<float*>(intermediate_128++));\r
+ auto xmm5 = _mm_load_ps(reinterpret_cast<float*>(intermediate_128++));\r
+ auto xmm6 = _mm_load_ps(reinterpret_cast<float*>(intermediate_128++));\r
+ auto xmm7 = _mm_load_ps(reinterpret_cast<float*>(intermediate_128++));\r
+ \r
+ _mm_stream_si128(result_128++, _mm_cvtps_epi32(xmm0));\r
+ _mm_stream_si128(result_128++, _mm_cvtps_epi32(xmm1));\r
+ _mm_stream_si128(result_128++, _mm_cvtps_epi32(xmm2));\r
+ _mm_stream_si128(result_128++, _mm_cvtps_epi32(xmm3));\r
+ _mm_stream_si128(result_128++, _mm_cvtps_epi32(xmm4));\r
+ _mm_stream_si128(result_128++, _mm_cvtps_epi32(xmm5));\r
+ _mm_stream_si128(result_128++, _mm_cvtps_epi32(xmm6));\r
+ _mm_stream_si128(result_128++, _mm_cvtps_epi32(xmm7));\r
+ }\r
+ }\r
+ , ap);\r
\r
items.clear();\r
prev_frame_transforms_ = std::move(next_frame_transforms); \r
\r
+ result.resize(format_desc_.audio_samples_per_frame);\r
return std::move(result);\r
}\r
};\r