]> git.sesse.net Git - casparcg/blob - modules/bluefish/consumer/bluefish_consumer.cpp
Use A_mempy/A_memset.
[casparcg] / modules / bluefish / consumer / bluefish_consumer.cpp
1 /*\r
2 * Copyright (c) 2011 Sveriges Television AB <info@casparcg.com>\r
3 *\r
4 * This file is part of CasparCG (www.casparcg.com).\r
5 *\r
6 * CasparCG is free software: you can redistribute it and/or modify\r
7 * it under the terms of the GNU General Public License as published by\r
8 * the Free Software Foundation, either version 3 of the License, or\r
9 * (at your option) any later version.\r
10 *\r
11 * CasparCG is distributed in the hope that it will be useful,\r
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of\r
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the\r
14 * GNU General Public License for more details.\r
15 *\r
16 * You should have received a copy of the GNU General Public License\r
17 * along with CasparCG. If not, see <http://www.gnu.org/licenses/>.\r
18 *\r
19 * Author: Robert Nagy, ronag89@gmail.com\r
20 */\r
21  \r
22 #include "../StdAfx.h"\r
23 \r
24 #include "bluefish_consumer.h"\r
25 #include "../util/blue_velvet.h"\r
26 #include "../util/memory.h"\r
27 \r
28 #include <core/video_format.h>\r
29 #include <core/mixer/read_frame.h>\r
30 \r
31 #include <common/concurrency/executor.h>\r
32 #include <common/diagnostics/graph.h>\r
33 #include <common/memory/memshfl.h>\r
34 #include <common/utility/timer.h>\r
35 #include <common/utility/assert.h>\r
36 \r
37 #include <core/consumer/frame_consumer.h>\r
38 #include <core/mixer/audio/audio_util.h>\r
39 \r
40 #include <tbb/concurrent_queue.h>\r
41 \r
42 #include <boost/timer.hpp>\r
43 #include <boost/range/algorithm.hpp>\r
44 #include <boost/property_tree/ptree.hpp>\r
45 \r
46 #include <asmlib.h>\r
47 \r
48 #include <memory>\r
49 #include <array>\r
50 \r
51 namespace caspar { namespace bluefish { \r
52                         \r
53 struct bluefish_consumer : boost::noncopyable\r
54 {\r
55         safe_ptr<CBlueVelvet4>                          blue_;\r
56         const unsigned int                                      device_index_;\r
57         const core::video_format_desc           format_desc_;\r
58         const int                                                       channel_index_;\r
59 \r
60         const std::wstring                                      model_name_;\r
61 \r
62         safe_ptr<diagnostics::graph>            graph_;\r
63         boost::timer                                            frame_timer_;\r
64         boost::timer                                            tick_timer_;\r
65         boost::timer                                            sync_timer_;    \r
66                         \r
67         unsigned int                                            vid_fmt_;\r
68 \r
69         std::array<blue_dma_buffer_ptr, 4>      reserved_frames_;       \r
70         tbb::concurrent_bounded_queue<std::shared_ptr<core::read_frame>> frame_buffer_;\r
71         \r
72         const bool                                                      embedded_audio_;\r
73         const bool                                                      key_only_;\r
74                 \r
75         executor                                                        executor_;\r
76 public:\r
77         bluefish_consumer(const core::video_format_desc& format_desc, int device_index, bool embedded_audio, bool key_only, int channel_index) \r
78                 : blue_(create_blue(device_index))\r
79                 , device_index_(device_index)\r
80                 , format_desc_(format_desc) \r
81                 , channel_index_(channel_index)\r
82                 , model_name_(get_card_desc(*blue_))\r
83                 , vid_fmt_(get_video_mode(*blue_, format_desc))\r
84                 , embedded_audio_(embedded_audio)\r
85                 , key_only_(key_only)\r
86                 , executor_(print())\r
87         {\r
88                 executor_.set_capacity(1);\r
89 \r
90                 graph_->add_guide("tick-time", 0.5);\r
91                 graph_->set_color("tick-time", diagnostics::color(0.0f, 0.6f, 0.9f));   \r
92                 graph_->add_guide("frame-time", 0.5f);  \r
93                 graph_->set_color("sync-time", diagnostics::color(1.0f, 0.0f, 0.0f));\r
94                 graph_->set_color("frame-time", diagnostics::color(0.5f, 1.0f, 0.2f));\r
95                 graph_->set_text(print());\r
96                 diagnostics::register_graph(graph_);\r
97                         \r
98                 //Setting output Video mode\r
99                 if(BLUE_FAIL(set_card_property(blue_, VIDEO_MODE, vid_fmt_))) \r
100                         BOOST_THROW_EXCEPTION(caspar_exception() << wmsg_info(print() + L" Failed to set videomode."));\r
101 \r
102                 //Select Update Mode for output\r
103                 if(BLUE_FAIL(set_card_property(blue_, VIDEO_UPDATE_TYPE, UPD_FMT_FRAME))) \r
104                         BOOST_THROW_EXCEPTION(caspar_exception() << wmsg_info(print() + L" Failed to set update type."));\r
105         \r
106                 disable_video_output();\r
107 \r
108                 //Enable dual link output\r
109                 if(BLUE_FAIL(set_card_property(blue_, VIDEO_DUAL_LINK_OUTPUT, 1)))\r
110                         BOOST_THROW_EXCEPTION(caspar_exception() << wmsg_info(print() + L" Failed to enable dual link."));\r
111 \r
112                 if(BLUE_FAIL(set_card_property(blue_, VIDEO_DUAL_LINK_OUTPUT_SIGNAL_FORMAT_TYPE, Signal_FormatType_4224)))\r
113                         BOOST_THROW_EXCEPTION(caspar_exception() << wmsg_info(print() + L" Failed to set dual link format type to 4:2:2:4."));\r
114                         \r
115                 //Select output memory format\r
116                 if(BLUE_FAIL(set_card_property(blue_, VIDEO_MEMORY_FORMAT, MEM_FMT_ARGB_PC))) \r
117                         BOOST_THROW_EXCEPTION(caspar_exception() << wmsg_info(print() + L" Failed to set memory format."));\r
118                 \r
119                 //Select image orientation\r
120                 if(BLUE_FAIL(set_card_property(blue_, VIDEO_IMAGE_ORIENTATION, ImageOrientation_Normal)))\r
121                         CASPAR_LOG(warning) << print() << L" Failed to set image orientation to normal.";       \r
122 \r
123                 // Select data range\r
124                 if(BLUE_FAIL(set_card_property(blue_, VIDEO_RGB_DATA_RANGE, CGR_RANGE))) \r
125                         CASPAR_LOG(warning) << print() << L" Failed to set RGB data range to CGR.";     \r
126                 \r
127                 if(BLUE_FAIL(set_card_property(blue_, VIDEO_PREDEFINED_COLOR_MATRIX, vid_fmt_ == VID_FMT_PAL ? MATRIX_601_CGR : MATRIX_709_CGR)))\r
128                         CASPAR_LOG(warning) << print() << L" Failed to set colormatrix to " << (vid_fmt_ == VID_FMT_PAL ? L"601 CGR" : L"709 CGR") << L".";\r
129 \r
130                 if(!embedded_audio_)\r
131                 {\r
132                         if(BLUE_FAIL(set_card_property(blue_, EMBEDEDDED_AUDIO_OUTPUT, 0))) \r
133                                 CASPAR_LOG(warning) << TEXT("BLUECARD ERROR: Failed to disable embedded audio.");                       \r
134                         CASPAR_LOG(info) << print() << TEXT(" Disabled embedded-audio.");\r
135                 }\r
136                 else\r
137                 {\r
138                         if(BLUE_FAIL(set_card_property(blue_, EMBEDEDDED_AUDIO_OUTPUT, blue_emb_audio_enable | blue_emb_audio_group1_enable))) \r
139                                 CASPAR_LOG(warning) << print() << TEXT(" Failed to enable embedded audio.");                    \r
140                         CASPAR_LOG(info) << print() << TEXT(" Enabled embedded-audio.");\r
141                 }\r
142                 \r
143                 if (blue_->has_output_key()) \r
144                 {\r
145                         int dummy = TRUE; int v4444 = FALSE; int invert = FALSE; int white = FALSE;\r
146                         blue_->set_output_key(dummy, v4444, invert, white);\r
147                 }\r
148 \r
149                 if(blue_->GetHDCardType(device_index_) != CRD_HD_INVALID) \r
150                         blue_->Set_DownConverterSignalType(vid_fmt_ == VID_FMT_PAL ? SD_SDI : HD_SDI);  \r
151         \r
152                 if(BLUE_FAIL(set_card_property(blue_, VIDEO_OUTPUT_ENGINE, VIDEO_ENGINE_FRAMESTORE))) \r
153                         CASPAR_LOG(warning) << print() << TEXT(" Failed to set video engine."); \r
154                 \r
155                 enable_video_output();\r
156                                                 \r
157                 int n = 0;\r
158                 boost::range::generate(reserved_frames_, [&]{return std::make_shared<blue_dma_buffer>(format_desc_.size, n++);});\r
159         }\r
160 \r
161         ~bluefish_consumer()\r
162         {\r
163                 try\r
164                 {\r
165                         executor_.invoke([&]\r
166                         {\r
167                                 disable_video_output();\r
168                                 blue_->device_detach();         \r
169                         });\r
170                 }\r
171                 catch(...)\r
172                 {\r
173                         CASPAR_LOG_CURRENT_EXCEPTION();\r
174                 }\r
175         }\r
176         \r
177         void enable_video_output()\r
178         {\r
179                 if(!BLUE_PASS(set_card_property(blue_, VIDEO_BLACKGENERATOR, 0)))\r
180                         CASPAR_LOG(error) << print() << TEXT(" Failed to disable video output.");       \r
181         }\r
182 \r
183         void disable_video_output()\r
184         {\r
185                 blue_->video_playback_stop(0,0);\r
186                 if(!BLUE_PASS(set_card_property(blue_, VIDEO_BLACKGENERATOR, 1)))\r
187                         CASPAR_LOG(error)<< print() << TEXT(" Failed to disable video output.");                \r
188         }\r
189         \r
190         void send(const safe_ptr<core::read_frame>& frame)\r
191         {                                       \r
192                 executor_.begin_invoke([=]\r
193                 {\r
194                         try\r
195                         {       \r
196                                 display_frame(frame);                           \r
197                                 graph_->update_value("tick-time", static_cast<float>(tick_timer_.elapsed()*format_desc_.fps*0.5));\r
198                                 tick_timer_.restart();\r
199                         }\r
200                         catch(...)\r
201                         {\r
202                                 CASPAR_LOG_CURRENT_EXCEPTION();\r
203                         }\r
204                 });\r
205         }\r
206 \r
207         void display_frame(const safe_ptr<core::read_frame>& frame)\r
208         {\r
209                 // Sync\r
210 \r
211                 sync_timer_.restart();\r
212                 unsigned long n_field = 0;\r
213                 blue_->wait_output_video_synch(UPD_FMT_FRAME, n_field);\r
214                 graph_->update_value("sync-time", sync_timer_.elapsed()*format_desc_.fps*0.5);\r
215                 \r
216                 frame_timer_.restart();         \r
217 \r
218                 // Copy to local buffers\r
219                 \r
220                 if(!frame->image_data().empty())\r
221                 {\r
222                         if(key_only_)                                           \r
223                                 aligned_memshfl(reserved_frames_.front()->image_data(), std::begin(frame->image_data()), frame->image_data().size(), 0x0F0F0F0F, 0x0B0B0B0B, 0x07070707, 0x03030303);\r
224                         else\r
225                                 A_memcpy(reserved_frames_.front()->image_data(), std::begin(frame->image_data()), frame->image_data().size());\r
226                 }\r
227                 else\r
228                         A_memset(reserved_frames_.front()->image_data(), 0, reserved_frames_.front()->image_size());\r
229                                                                 \r
230 \r
231                 // Send and display\r
232 \r
233                 if(embedded_audio_)\r
234                 {               \r
235                         auto frame_audio = core::audio_32_to_24(frame->audio_data());                   \r
236                         encode_hanc(reinterpret_cast<BLUE_UINT32*>(reserved_frames_.front()->hanc_data()), \r
237                                                 frame_audio.data(), \r
238                                                 static_cast<int>(frame->audio_data().size()/format_desc_.audio_channels), \r
239                                                 format_desc_.audio_channels);\r
240                                                                 \r
241                         blue_->system_buffer_write_async(const_cast<uint8_t*>(reserved_frames_.front()->image_data()), \r
242                                                                                         static_cast<unsigned long>(reserved_frames_.front()->image_size()), \r
243                                                                                         nullptr, \r
244                                                                                         BlueImage_HANC_DMABuffer(reserved_frames_.front()->id(), BLUE_DATA_IMAGE));\r
245 \r
246                         blue_->system_buffer_write_async(reserved_frames_.front()->hanc_data(),\r
247                                                                                         static_cast<unsigned long>(reserved_frames_.front()->hanc_size()), \r
248                                                                                         nullptr,                 \r
249                                                                                         BlueImage_HANC_DMABuffer(reserved_frames_.front()->id(), BLUE_DATA_HANC));\r
250 \r
251                         if(BLUE_FAIL(blue_->render_buffer_update(BlueBuffer_Image_HANC(reserved_frames_.front()->id()))))\r
252                                 CASPAR_LOG(warning) << print() << TEXT(" render_buffer_update failed.");\r
253                 }\r
254                 else\r
255                 {\r
256                         blue_->system_buffer_write_async(const_cast<uint8_t*>(reserved_frames_.front()->image_data()),\r
257                                                                                         static_cast<unsigned long>(reserved_frames_.front()->image_size()), \r
258                                                                                         nullptr,                 \r
259                                                                                         BlueImage_DMABuffer(reserved_frames_.front()->id(), BLUE_DATA_IMAGE));\r
260                         \r
261                         if(BLUE_FAIL(blue_->render_buffer_update(BlueBuffer_Image(reserved_frames_.front()->id()))))\r
262                                 CASPAR_LOG(warning) << print() << TEXT(" render_buffer_update failed.");\r
263                 }\r
264 \r
265                 boost::range::rotate(reserved_frames_, std::begin(reserved_frames_)+1);\r
266                 \r
267                 graph_->update_value("frame-time", static_cast<float>(frame_timer_.elapsed()*format_desc_.fps*0.5));\r
268         }\r
269 \r
270         void encode_hanc(BLUE_UINT32* hanc_data, void* audio_data, int audio_samples, int audio_nchannels)\r
271         {       \r
272                 const auto sample_type = AUDIO_CHANNEL_24BIT | AUDIO_CHANNEL_LITTLEENDIAN;\r
273                 const auto emb_audio_flag = blue_emb_audio_enable | blue_emb_audio_group1_enable;\r
274                 \r
275                 hanc_stream_info_struct hanc_stream_info;\r
276                 memset(&hanc_stream_info, 0, sizeof(hanc_stream_info));\r
277                 \r
278                 hanc_stream_info.AudioDBNArray[0] = -1;\r
279                 hanc_stream_info.AudioDBNArray[1] = -1;\r
280                 hanc_stream_info.AudioDBNArray[2] = -1;\r
281                 hanc_stream_info.AudioDBNArray[3] = -1;\r
282                 hanc_stream_info.hanc_data_ptr    = hanc_data;\r
283                 hanc_stream_info.video_mode               = vid_fmt_;           \r
284                 \r
285                 if (!is_epoch_card(*blue_))\r
286                         encode_hanc_frame(&hanc_stream_info, audio_data, audio_nchannels, audio_samples, sample_type, emb_audio_flag);  \r
287                 else\r
288                         encode_hanc_frame_ex(blue_->has_video_cardtype(), &hanc_stream_info, audio_data, audio_nchannels, audio_samples, sample_type, emb_audio_flag);\r
289         }\r
290         \r
291         std::wstring print() const\r
292         {\r
293                 return model_name_ + L" [" + boost::lexical_cast<std::wstring>(channel_index_) + L"-" + \r
294                         boost::lexical_cast<std::wstring>(device_index_) + L"|" +  format_desc_.name + L"]";\r
295         }\r
296 };\r
297 \r
298 struct bluefish_consumer_proxy : public core::frame_consumer\r
299 {\r
300         std::unique_ptr<bluefish_consumer>      consumer_;\r
301         const int                                                       device_index_;\r
302         const bool                                                      embedded_audio_;\r
303         const bool                                                      key_only_;\r
304         std::vector<int>                                        audio_cadence_;\r
305 public:\r
306 \r
307         bluefish_consumer_proxy(int device_index, bool embedded_audio, bool key_only)\r
308                 : device_index_(device_index)\r
309                 , embedded_audio_(embedded_audio)\r
310                 , key_only_(key_only)\r
311         {\r
312         }\r
313         \r
314         ~bluefish_consumer_proxy()\r
315         {\r
316                 if(consumer_)\r
317                 {\r
318                         auto str = print();\r
319                         consumer_.reset();\r
320                         CASPAR_LOG(info) << str << L" Successfully Uninitialized.";     \r
321                 }\r
322         }\r
323 \r
324         // frame_consumer\r
325         \r
326         virtual void initialize(const core::video_format_desc& format_desc, int channel_index) override\r
327         {\r
328                 consumer_.reset(new bluefish_consumer(format_desc, device_index_, embedded_audio_, key_only_, channel_index));\r
329                 audio_cadence_ = format_desc.audio_cadence;\r
330                 CASPAR_LOG(info) << print() << L" Successfully Initialized.";   \r
331         }\r
332         \r
333         virtual bool send(const safe_ptr<core::read_frame>& frame) override\r
334         {\r
335                 CASPAR_VERIFY(audio_cadence_.front() == static_cast<size_t>(frame->audio_data().size()));\r
336                 boost::range::rotate(audio_cadence_, std::begin(audio_cadence_)+1);\r
337 \r
338                 consumer_->send(frame);\r
339                 return true;\r
340         }\r
341                 \r
342         virtual std::wstring print() const override\r
343         {\r
344                 return consumer_ ? consumer_->print() : L"[bluefish_consumer]";\r
345         }\r
346 \r
347         virtual boost::property_tree::wptree info() const override\r
348         {\r
349                 boost::property_tree::wptree info;\r
350                 info.add(L"type", L"bluefish-consumer");\r
351                 info.add(L"key-only", key_only_);\r
352                 info.add(L"device", device_index_);\r
353                 info.add(L"embedded-audio", embedded_audio_);\r
354                 return info;\r
355         }\r
356 \r
357         int buffer_depth() const override\r
358         {\r
359                 return 1;\r
360         }\r
361         \r
362         virtual int index() const override\r
363         {\r
364                 return 400 + device_index_;\r
365         }\r
366 };      \r
367 \r
368 safe_ptr<core::frame_consumer> create_consumer(const std::vector<std::wstring>& params)\r
369 {\r
370         if(params.size() < 1 || params[0] != L"BLUEFISH")\r
371                 return core::frame_consumer::empty();\r
372                 \r
373         const auto device_index = params.size() > 1 ? lexical_cast_or_default<int>(params[1], 1) : 1;\r
374 \r
375         const auto embedded_audio = std::find(params.begin(), params.end(), L"EMBEDDED_AUDIO") != params.end();\r
376         const auto key_only               = std::find(params.begin(), params.end(), L"KEY_ONLY")           != params.end();\r
377 \r
378         return make_safe<bluefish_consumer_proxy>(device_index, embedded_audio, key_only);\r
379 }\r
380 \r
381 safe_ptr<core::frame_consumer> create_consumer(const boost::property_tree::wptree& ptree) \r
382 {       \r
383         const auto device_index         = ptree.get(L"device",                  1);\r
384         const auto embedded_audio       = ptree.get(L"embedded-audio",  false);\r
385         const auto key_only                     = ptree.get(L"key-only",                false);\r
386 \r
387         return make_safe<bluefish_consumer_proxy>(device_index, embedded_audio, key_only);\r
388 }\r
389 \r
390 }}