vi.cpp 26 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843
  1. // Copyright 2018 yuzu emulator team
  2. // Licensed under GPLv2 or any later version
  3. // Refer to the license.txt file included.
  4. #include <algorithm>
  5. #include "common/alignment.h"
  6. #include "common/scope_exit.h"
  7. #include "core/core_timing.h"
  8. #include "core/hle/ipc_helpers.h"
  9. #include "core/hle/service/nvdrv/devices/nvdisp_disp0.h"
  10. #include "core/hle/service/nvdrv/nvdrv_a.h"
  11. #include "core/hle/service/vi/vi.h"
  12. #include "core/hle/service/vi/vi_m.h"
  13. #include "video_core/renderer_base.h"
  14. #include "video_core/video_core.h"
  15. namespace Service {
  16. namespace VI {
  17. constexpr size_t SCREEN_REFRESH_RATE = 60;
  18. constexpr u64 frame_ticks = static_cast<u64>(BASE_CLOCK_RATE / SCREEN_REFRESH_RATE);
  19. class Parcel {
  20. public:
  21. // This default size was chosen arbitrarily.
  22. static constexpr size_t DefaultBufferSize = 0x40;
  23. Parcel() : buffer(DefaultBufferSize) {}
  24. Parcel(std::vector<u8> data) : buffer(std::move(data)) {}
  25. virtual ~Parcel() = default;
  26. template <typename T>
  27. T Read() {
  28. T val;
  29. std::memcpy(&val, buffer.data() + read_index, sizeof(T));
  30. read_index += sizeof(T);
  31. read_index = Common::AlignUp(read_index, 4);
  32. return val;
  33. }
  34. template <typename T>
  35. T ReadUnaligned() {
  36. T val;
  37. std::memcpy(&val, buffer.data() + read_index, sizeof(T));
  38. read_index += sizeof(T);
  39. return val;
  40. }
  41. std::vector<u8> ReadBlock(size_t length) {
  42. std::vector<u8> data(length);
  43. std::memcpy(data.data(), buffer.data() + read_index, length);
  44. read_index += length;
  45. read_index = Common::AlignUp(read_index, 4);
  46. return data;
  47. }
  48. std::u16string ReadInterfaceToken() {
  49. u32 unknown = Read<u32_le>();
  50. u32 length = Read<u32_le>();
  51. std::u16string token{};
  52. for (u32 ch = 0; ch < length + 1; ++ch) {
  53. token.push_back(ReadUnaligned<u16_le>());
  54. }
  55. read_index = Common::AlignUp(read_index, 4);
  56. return token;
  57. }
  58. template <typename T>
  59. void Write(const T& val) {
  60. if (buffer.size() < write_index + sizeof(T))
  61. buffer.resize(buffer.size() + sizeof(T) + DefaultBufferSize);
  62. std::memcpy(buffer.data() + write_index, &val, sizeof(T));
  63. write_index += sizeof(T);
  64. write_index = Common::AlignUp(write_index, 4);
  65. }
  66. void Deserialize() {
  67. Header header{};
  68. std::memcpy(&header, buffer.data(), sizeof(Header));
  69. read_index = header.data_offset;
  70. DeserializeData();
  71. }
  72. std::vector<u8> Serialize() {
  73. ASSERT(read_index == 0);
  74. write_index = sizeof(Header);
  75. SerializeData();
  76. Header header{};
  77. header.data_offset = sizeof(Header);
  78. header.data_size = write_index - sizeof(Header);
  79. std::memcpy(buffer.data(), &header, sizeof(Header));
  80. return buffer;
  81. }
  82. protected:
  83. virtual void SerializeData(){};
  84. virtual void DeserializeData(){};
  85. private:
  86. struct Header {
  87. u32_le data_size;
  88. u32_le data_offset;
  89. u32_le objects_size;
  90. u32_le objects_offset;
  91. };
  92. static_assert(sizeof(Header) == 16, "ParcelHeader has wrong size");
  93. std::vector<u8> buffer;
  94. size_t read_index = 0;
  95. size_t write_index = 0;
  96. };
  97. class NativeWindow : public Parcel {
  98. public:
  99. NativeWindow(u32 id) : Parcel() {
  100. data.id = id;
  101. }
  102. ~NativeWindow() override = default;
  103. protected:
  104. void SerializeData() override {
  105. Write(data);
  106. }
  107. private:
  108. struct Data {
  109. u32_le magic = 2;
  110. u32_le process_id;
  111. u32_le id;
  112. INSERT_PADDING_BYTES(0xC);
  113. std::array<u8, 8> dspdrv = {'d', 's', 'p', 'd', 'r', 'v'};
  114. INSERT_PADDING_BYTES(8);
  115. };
  116. static_assert(sizeof(Data) == 0x28, "ParcelData has wrong size");
  117. Data data{};
  118. };
  119. class IGBPConnectRequestParcel : public Parcel {
  120. public:
  121. IGBPConnectRequestParcel(const std::vector<u8>& buffer) : Parcel(buffer) {
  122. Deserialize();
  123. }
  124. ~IGBPConnectRequestParcel() override = default;
  125. void DeserializeData() {
  126. std::u16string token = ReadInterfaceToken();
  127. data = Read<Data>();
  128. }
  129. struct Data {
  130. u32_le unk;
  131. u32_le api;
  132. u32_le producer_controlled_by_app;
  133. };
  134. Data data;
  135. };
  136. class IGBPConnectResponseParcel : public Parcel {
  137. public:
  138. IGBPConnectResponseParcel(u32 width, u32 height) : Parcel() {
  139. data.width = width;
  140. data.height = height;
  141. }
  142. ~IGBPConnectResponseParcel() override = default;
  143. protected:
  144. void SerializeData() override {
  145. Write(data);
  146. }
  147. private:
  148. struct Data {
  149. u32_le width;
  150. u32_le height;
  151. u32_le transform_hint;
  152. u32_le num_pending_buffers;
  153. u32_le status;
  154. };
  155. static_assert(sizeof(Data) == 20, "ParcelData has wrong size");
  156. Data data{};
  157. };
  158. class IGBPSetPreallocatedBufferRequestParcel : public Parcel {
  159. public:
  160. IGBPSetPreallocatedBufferRequestParcel(const std::vector<u8>& buffer) : Parcel(buffer) {
  161. Deserialize();
  162. }
  163. ~IGBPSetPreallocatedBufferRequestParcel() override = default;
  164. void DeserializeData() {
  165. std::u16string token = ReadInterfaceToken();
  166. data = Read<Data>();
  167. ASSERT(data.graphic_buffer_length == sizeof(IGBPBuffer));
  168. buffer = Read<IGBPBuffer>();
  169. }
  170. struct Data {
  171. u32_le slot;
  172. INSERT_PADDING_WORDS(1);
  173. u32_le graphic_buffer_length;
  174. INSERT_PADDING_WORDS(1);
  175. };
  176. Data data;
  177. IGBPBuffer buffer;
  178. };
  179. class IGBPSetPreallocatedBufferResponseParcel : public Parcel {
  180. public:
  181. IGBPSetPreallocatedBufferResponseParcel() : Parcel() {}
  182. ~IGBPSetPreallocatedBufferResponseParcel() override = default;
  183. protected:
  184. void SerializeData() override {
  185. // TODO(Subv): Find out what this means
  186. Write<u32>(0);
  187. }
  188. };
  189. class IGBPDequeueBufferRequestParcel : public Parcel {
  190. public:
  191. IGBPDequeueBufferRequestParcel(const std::vector<u8>& buffer) : Parcel(buffer) {
  192. Deserialize();
  193. }
  194. ~IGBPDequeueBufferRequestParcel() override = default;
  195. void DeserializeData() {
  196. std::u16string token = ReadInterfaceToken();
  197. data = Read<Data>();
  198. }
  199. struct Data {
  200. u32_le pixel_format;
  201. u32_le width;
  202. u32_le height;
  203. u32_le get_frame_timestamps;
  204. u32_le usage;
  205. };
  206. Data data;
  207. };
  208. class IGBPDequeueBufferResponseParcel : public Parcel {
  209. public:
  210. IGBPDequeueBufferResponseParcel(u32 slot) : Parcel(), slot(slot) {}
  211. ~IGBPDequeueBufferResponseParcel() override = default;
  212. protected:
  213. void SerializeData() override {
  214. Write(slot);
  215. // TODO(Subv): Find out how this Fence is used.
  216. std::array<u32_le, 11> fence = {};
  217. Write(fence);
  218. Write<u32_le>(0);
  219. }
  220. u32_le slot;
  221. };
  222. class IGBPRequestBufferRequestParcel : public Parcel {
  223. public:
  224. IGBPRequestBufferRequestParcel(const std::vector<u8>& buffer) : Parcel(buffer) {
  225. Deserialize();
  226. }
  227. ~IGBPRequestBufferRequestParcel() override = default;
  228. void DeserializeData() {
  229. std::u16string token = ReadInterfaceToken();
  230. slot = Read<u32_le>();
  231. }
  232. u32_le slot;
  233. };
  234. class IGBPRequestBufferResponseParcel : public Parcel {
  235. public:
  236. IGBPRequestBufferResponseParcel(IGBPBuffer buffer) : Parcel(), buffer(buffer) {}
  237. ~IGBPRequestBufferResponseParcel() override = default;
  238. protected:
  239. void SerializeData() override {
  240. // TODO(Subv): Find out what this all means
  241. Write<u32_le>(1);
  242. Write<u32_le>(sizeof(IGBPBuffer));
  243. Write<u32_le>(0); // Unknown
  244. Write(buffer);
  245. Write<u32_le>(0);
  246. }
  247. IGBPBuffer buffer;
  248. };
  249. class IGBPQueueBufferRequestParcel : public Parcel {
  250. public:
  251. IGBPQueueBufferRequestParcel(const std::vector<u8>& buffer) : Parcel(buffer) {
  252. Deserialize();
  253. }
  254. ~IGBPQueueBufferRequestParcel() override = default;
  255. void DeserializeData() {
  256. std::u16string token = ReadInterfaceToken();
  257. data = Read<Data>();
  258. }
  259. struct Data {
  260. u32_le slot;
  261. INSERT_PADDING_WORDS(2);
  262. u32_le timestamp;
  263. INSERT_PADDING_WORDS(20);
  264. };
  265. static_assert(sizeof(Data) == 96, "ParcelData has wrong size");
  266. Data data;
  267. };
  268. class IGBPQueueBufferResponseParcel : public Parcel {
  269. public:
  270. IGBPQueueBufferResponseParcel(u32 width, u32 height) : Parcel() {
  271. data.width = width;
  272. data.height = height;
  273. }
  274. ~IGBPQueueBufferResponseParcel() override = default;
  275. protected:
  276. void SerializeData() override {
  277. Write(data);
  278. }
  279. private:
  280. struct Data {
  281. u32_le width;
  282. u32_le height;
  283. u32_le transform_hint;
  284. u32_le num_pending_buffers;
  285. u32_le status;
  286. };
  287. static_assert(sizeof(Data) == 20, "ParcelData has wrong size");
  288. Data data{};
  289. };
  290. class IHOSBinderDriver final : public ServiceFramework<IHOSBinderDriver> {
  291. public:
  292. IHOSBinderDriver(std::shared_ptr<NVFlinger> nv_flinger)
  293. : ServiceFramework("IHOSBinderDriver"), nv_flinger(std::move(nv_flinger)) {
  294. static const FunctionInfo functions[] = {
  295. {0, &IHOSBinderDriver::TransactParcel, "TransactParcel"},
  296. {1, &IHOSBinderDriver::AdjustRefcount, "AdjustRefcount"},
  297. {2, nullptr, "GetNativeHandle"},
  298. {3, nullptr, "TransactParcelAuto"},
  299. };
  300. RegisterHandlers(functions);
  301. }
  302. ~IHOSBinderDriver() = default;
  303. private:
  304. enum class TransactionId {
  305. RequestBuffer = 1,
  306. SetBufferCount = 2,
  307. DequeueBuffer = 3,
  308. DetachBuffer = 4,
  309. DetachNextBuffer = 5,
  310. AttachBuffer = 6,
  311. QueueBuffer = 7,
  312. CancelBuffer = 8,
  313. Query = 9,
  314. Connect = 10,
  315. Disconnect = 11,
  316. AllocateBuffers = 13,
  317. SetPreallocatedBuffer = 14
  318. };
  319. void TransactParcel(Kernel::HLERequestContext& ctx) {
  320. IPC::RequestParser rp{ctx};
  321. u32 id = rp.Pop<u32>();
  322. auto transaction = static_cast<TransactionId>(rp.Pop<u32>());
  323. u32 flags = rp.Pop<u32>();
  324. auto& input_buffer = ctx.BufferDescriptorA()[0];
  325. std::vector<u8> input_data(input_buffer.Size());
  326. Memory::ReadBlock(input_buffer.Address(), input_data.data(), input_buffer.Size());
  327. auto& output_buffer = ctx.BufferDescriptorB()[0];
  328. auto buffer_queue = nv_flinger->GetBufferQueue(id);
  329. if (transaction == TransactionId::Connect) {
  330. IGBPConnectRequestParcel request{input_data};
  331. IGBPConnectResponseParcel response{1280, 720};
  332. auto response_buffer = response.Serialize();
  333. Memory::WriteBlock(output_buffer.Address(), response_buffer.data(),
  334. output_buffer.Size());
  335. } else if (transaction == TransactionId::SetPreallocatedBuffer) {
  336. IGBPSetPreallocatedBufferRequestParcel request{input_data};
  337. buffer_queue->SetPreallocatedBuffer(request.data.slot, request.buffer);
  338. IGBPSetPreallocatedBufferResponseParcel response{};
  339. auto response_buffer = response.Serialize();
  340. Memory::WriteBlock(output_buffer.Address(), response_buffer.data(),
  341. output_buffer.Size());
  342. } else if (transaction == TransactionId::DequeueBuffer) {
  343. IGBPDequeueBufferRequestParcel request{input_data};
  344. u32 slot = buffer_queue->DequeueBuffer(request.data.pixel_format, request.data.width,
  345. request.data.height);
  346. IGBPDequeueBufferResponseParcel response{slot};
  347. auto response_buffer = response.Serialize();
  348. Memory::WriteBlock(output_buffer.Address(), response_buffer.data(),
  349. output_buffer.Size());
  350. } else if (transaction == TransactionId::RequestBuffer) {
  351. IGBPRequestBufferRequestParcel request{input_data};
  352. auto& buffer = buffer_queue->RequestBuffer(request.slot);
  353. IGBPRequestBufferResponseParcel response{buffer};
  354. auto response_buffer = response.Serialize();
  355. Memory::WriteBlock(output_buffer.Address(), response_buffer.data(),
  356. output_buffer.Size());
  357. } else if (transaction == TransactionId::QueueBuffer) {
  358. IGBPQueueBufferRequestParcel request{input_data};
  359. buffer_queue->QueueBuffer(request.data.slot);
  360. IGBPQueueBufferResponseParcel response{1280, 720};
  361. auto response_buffer = response.Serialize();
  362. Memory::WriteBlock(output_buffer.Address(), response_buffer.data(),
  363. output_buffer.Size());
  364. } else {
  365. ASSERT_MSG(false, "Unimplemented");
  366. }
  367. LOG_WARNING(Service, "(STUBBED) called");
  368. IPC::RequestBuilder rb{ctx, 2};
  369. rb.Push(RESULT_SUCCESS);
  370. }
  371. void AdjustRefcount(Kernel::HLERequestContext& ctx) {
  372. IPC::RequestParser rp{ctx};
  373. u32 id = rp.Pop<u32>();
  374. s32 addval = rp.PopRaw<s32>();
  375. u32 type = rp.Pop<u32>();
  376. LOG_WARNING(Service, "(STUBBED) called id=%u, addval=%08X, type=%08X", id, addval, type);
  377. IPC::RequestBuilder rb{ctx, 2};
  378. rb.Push(RESULT_SUCCESS);
  379. }
  380. std::shared_ptr<NVFlinger> nv_flinger;
  381. };
  382. class ISystemDisplayService final : public ServiceFramework<ISystemDisplayService> {
  383. public:
  384. ISystemDisplayService() : ServiceFramework("ISystemDisplayService") {
  385. static const FunctionInfo functions[] = {
  386. {1200, nullptr, "GetZOrderCountMin"},
  387. {2205, &ISystemDisplayService::SetLayerZ, "SetLayerZ"},
  388. };
  389. RegisterHandlers(functions);
  390. }
  391. ~ISystemDisplayService() = default;
  392. private:
  393. void SetLayerZ(Kernel::HLERequestContext& ctx) {
  394. LOG_WARNING(Service, "(STUBBED) called");
  395. IPC::RequestParser rp{ctx};
  396. u64 layer_id = rp.Pop<u64>();
  397. u64 z_value = rp.Pop<u64>();
  398. IPC::RequestBuilder rb = rp.MakeBuilder(2, 0, 0, 0);
  399. rb.Push(RESULT_SUCCESS);
  400. }
  401. };
  402. class IManagerDisplayService final : public ServiceFramework<IManagerDisplayService> {
  403. public:
  404. IManagerDisplayService(std::shared_ptr<NVFlinger> nv_flinger)
  405. : ServiceFramework("IManagerDisplayService"), nv_flinger(std::move(nv_flinger)) {
  406. static const FunctionInfo functions[] = {
  407. {1102, nullptr, "GetDisplayResolution"},
  408. {2010, &IManagerDisplayService::CreateManagedLayer, "CreateManagedLayer"},
  409. {6000, &IManagerDisplayService::AddToLayerStack, "AddToLayerStack"},
  410. };
  411. RegisterHandlers(functions);
  412. }
  413. ~IManagerDisplayService() = default;
  414. private:
  415. void CreateManagedLayer(Kernel::HLERequestContext& ctx) {
  416. LOG_WARNING(Service, "(STUBBED) called");
  417. IPC::RequestParser rp{ctx};
  418. u32 unknown = rp.Pop<u32>();
  419. rp.Skip(1, false);
  420. u64 display = rp.Pop<u64>();
  421. u64 aruid = rp.Pop<u64>();
  422. u64 layer_id = nv_flinger->CreateLayer(display);
  423. IPC::RequestBuilder rb = rp.MakeBuilder(4, 0, 0, 0);
  424. rb.Push(RESULT_SUCCESS);
  425. rb.Push(layer_id);
  426. }
  427. void AddToLayerStack(Kernel::HLERequestContext& ctx) {
  428. LOG_WARNING(Service, "(STUBBED) called");
  429. IPC::RequestParser rp{ctx};
  430. u32 stack = rp.Pop<u32>();
  431. u64 layer_id = rp.Pop<u64>();
  432. IPC::RequestBuilder rb = rp.MakeBuilder(2, 0, 0, 0);
  433. rb.Push(RESULT_SUCCESS);
  434. }
  435. std::shared_ptr<NVFlinger> nv_flinger;
  436. };
  437. void IApplicationDisplayService::GetRelayService(Kernel::HLERequestContext& ctx) {
  438. LOG_WARNING(Service, "(STUBBED) called");
  439. IPC::RequestBuilder rb{ctx, 2, 0, 0, 1};
  440. rb.Push(RESULT_SUCCESS);
  441. rb.PushIpcInterface<IHOSBinderDriver>(nv_flinger);
  442. }
  443. void IApplicationDisplayService::GetSystemDisplayService(Kernel::HLERequestContext& ctx) {
  444. LOG_WARNING(Service, "(STUBBED) called");
  445. IPC::RequestBuilder rb{ctx, 2, 0, 0, 1};
  446. rb.Push(RESULT_SUCCESS);
  447. rb.PushIpcInterface<ISystemDisplayService>();
  448. }
  449. void IApplicationDisplayService::GetManagerDisplayService(Kernel::HLERequestContext& ctx) {
  450. LOG_WARNING(Service, "(STUBBED) called");
  451. IPC::RequestBuilder rb{ctx, 2, 0, 0, 1};
  452. rb.Push(RESULT_SUCCESS);
  453. rb.PushIpcInterface<IManagerDisplayService>(nv_flinger);
  454. }
  455. void IApplicationDisplayService::OpenDisplay(Kernel::HLERequestContext& ctx) {
  456. LOG_WARNING(Service, "(STUBBED) called");
  457. IPC::RequestParser rp{ctx};
  458. auto name_buf = rp.PopRaw<std::array<u8, 0x40>>();
  459. auto end = std::find(name_buf.begin(), name_buf.end(), '\0');
  460. std::string name(name_buf.begin(), end);
  461. ASSERT_MSG(name == "Default", "Non-default displays aren't supported yet");
  462. IPC::RequestBuilder rb = rp.MakeBuilder(4, 0, 0, 0);
  463. rb.Push(RESULT_SUCCESS);
  464. rb.Push<u64>(nv_flinger->OpenDisplay(name));
  465. }
  466. void IApplicationDisplayService::OpenLayer(Kernel::HLERequestContext& ctx) {
  467. LOG_WARNING(Service, "(STUBBED) called");
  468. IPC::RequestParser rp{ctx};
  469. auto name_buf = rp.PopRaw<std::array<u8, 0x40>>();
  470. auto end = std::find(name_buf.begin(), name_buf.end(), '\0');
  471. std::string display_name(name_buf.begin(), end);
  472. u64 layer_id = rp.Pop<u64>();
  473. u64 aruid = rp.Pop<u64>();
  474. auto& buffer = ctx.BufferDescriptorB()[0];
  475. u64 display_id = nv_flinger->OpenDisplay(display_name);
  476. u32 buffer_queue_id = nv_flinger->GetBufferQueueId(display_id, layer_id);
  477. NativeWindow native_window{buffer_queue_id};
  478. auto data = native_window.Serialize();
  479. Memory::WriteBlock(buffer.Address(), data.data(), data.size());
  480. IPC::RequestBuilder rb = rp.MakeBuilder(4, 0, 0, 0);
  481. rb.Push(RESULT_SUCCESS);
  482. rb.Push<u64>(data.size());
  483. }
  484. void IApplicationDisplayService::SetLayerScalingMode(Kernel::HLERequestContext& ctx) {
  485. LOG_WARNING(Service, "(STUBBED) called");
  486. IPC::RequestParser rp{ctx};
  487. u32 scaling_mode = rp.Pop<u32>();
  488. u64 unknown = rp.Pop<u64>();
  489. IPC::RequestBuilder rb = rp.MakeBuilder(2, 0, 0, 0);
  490. rb.Push(RESULT_SUCCESS);
  491. }
  492. void IApplicationDisplayService::GetDisplayVsyncEvent(Kernel::HLERequestContext& ctx) {
  493. LOG_WARNING(Service, "(STUBBED) called");
  494. IPC::RequestParser rp{ctx};
  495. u64 display_id = rp.Pop<u64>();
  496. auto vsync_event = nv_flinger->GetVsyncEvent(display_id);
  497. IPC::RequestBuilder rb = rp.MakeBuilder(2, 1, 0, 0);
  498. rb.Push(RESULT_SUCCESS);
  499. rb.PushCopyObjects(vsync_event);
  500. }
  501. IApplicationDisplayService::IApplicationDisplayService(std::shared_ptr<NVFlinger> nv_flinger)
  502. : ServiceFramework("IApplicationDisplayService"), nv_flinger(std::move(nv_flinger)) {
  503. static const FunctionInfo functions[] = {
  504. {100, &IApplicationDisplayService::GetRelayService, "GetRelayService"},
  505. {101, &IApplicationDisplayService::GetSystemDisplayService, "GetSystemDisplayService"},
  506. {102, &IApplicationDisplayService::GetManagerDisplayService, "GetManagerDisplayService"},
  507. {103, nullptr, "GetIndirectDisplayTransactionService"},
  508. {1000, nullptr, "ListDisplays"},
  509. {1010, &IApplicationDisplayService::OpenDisplay, "OpenDisplay"},
  510. {2101, &IApplicationDisplayService::SetLayerScalingMode, "SetLayerScalingMode"},
  511. {2020, &IApplicationDisplayService::OpenLayer, "OpenLayer"},
  512. {5202, &IApplicationDisplayService::GetDisplayVsyncEvent, "GetDisplayVsyncEvent"},
  513. };
  514. RegisterHandlers(functions);
  515. }
  516. void InstallInterfaces(SM::ServiceManager& service_manager) {
  517. std::make_shared<VI_M>()->InstallAsService(service_manager);
  518. }
  519. NVFlinger::NVFlinger() {
  520. // Add the different displays to the list of displays.
  521. Display default_{0, "Default"};
  522. Display external{1, "External"};
  523. Display edid{2, "Edid"};
  524. Display internal{3, "Internal"};
  525. displays.emplace_back(default_);
  526. displays.emplace_back(external);
  527. displays.emplace_back(edid);
  528. displays.emplace_back(internal);
  529. // Schedule the screen composition events
  530. composition_event =
  531. CoreTiming::RegisterEvent("ScreenCompositioin", [this](u64 userdata, int cycles_late) {
  532. Compose();
  533. CoreTiming::ScheduleEvent(frame_ticks - cycles_late, composition_event);
  534. });
  535. CoreTiming::ScheduleEvent(frame_ticks, composition_event);
  536. }
  537. NVFlinger::~NVFlinger() {
  538. CoreTiming::UnscheduleEvent(composition_event, 0);
  539. }
  540. u64 NVFlinger::OpenDisplay(const std::string& name) {
  541. LOG_WARNING(Service, "Opening display %s", name.c_str());
  542. // TODO(Subv): Currently we only support the Default display.
  543. ASSERT(name == "Default");
  544. auto itr = std::find_if(displays.begin(), displays.end(),
  545. [&](const Display& display) { return display.name == name; });
  546. ASSERT(itr != displays.end());
  547. return itr->id;
  548. }
  549. u64 NVFlinger::CreateLayer(u64 display_id) {
  550. auto& display = GetDisplay(display_id);
  551. ASSERT_MSG(display.layers.empty(), "Only one layer is supported per display at the moment");
  552. u64 layer_id = next_layer_id++;
  553. u32 buffer_queue_id = next_buffer_queue_id++;
  554. auto buffer_queue = std::make_shared<BufferQueue>(buffer_queue_id, layer_id);
  555. display.layers.emplace_back(layer_id, buffer_queue);
  556. buffer_queues.emplace_back(std::move(buffer_queue));
  557. return layer_id;
  558. }
  559. u32 NVFlinger::GetBufferQueueId(u64 display_id, u64 layer_id) {
  560. const auto& layer = GetLayer(display_id, layer_id);
  561. return layer.buffer_queue->GetId();
  562. }
  563. Kernel::SharedPtr<Kernel::Event> NVFlinger::GetVsyncEvent(u64 display_id) {
  564. const auto& display = GetDisplay(display_id);
  565. return display.vsync_event;
  566. }
  567. std::shared_ptr<BufferQueue> NVFlinger::GetBufferQueue(u32 id) const {
  568. auto itr = std::find_if(buffer_queues.begin(), buffer_queues.end(),
  569. [&](const auto& queue) { return queue->GetId() == id; });
  570. ASSERT(itr != buffer_queues.end());
  571. return *itr;
  572. }
  573. Display& NVFlinger::GetDisplay(u64 display_id) {
  574. auto itr = std::find_if(displays.begin(), displays.end(),
  575. [&](const Display& display) { return display.id == display_id; });
  576. ASSERT(itr != displays.end());
  577. return *itr;
  578. }
  579. Layer& NVFlinger::GetLayer(u64 display_id, u64 layer_id) {
  580. auto& display = GetDisplay(display_id);
  581. auto itr = std::find_if(display.layers.begin(), display.layers.end(),
  582. [&](const Layer& layer) { return layer.id == layer_id; });
  583. ASSERT(itr != display.layers.end());
  584. return *itr;
  585. }
  586. void NVFlinger::Compose() {
  587. for (auto& display : displays) {
  588. // Trigger vsync for this display at the end of drawing
  589. SCOPE_EXIT({ display.vsync_event->Signal(); });
  590. // Don't do anything for displays without layers.
  591. if (display.layers.empty())
  592. continue;
  593. // TODO(Subv): Support more than 1 layer.
  594. ASSERT_MSG(display.layers.size() == 1, "Max 1 layer per display is supported");
  595. Layer& layer = display.layers[0];
  596. auto& buffer_queue = layer.buffer_queue;
  597. // Search for a queued buffer and acquire it
  598. auto buffer = buffer_queue->AcquireBuffer();
  599. if (buffer == boost::none) {
  600. // There was no queued buffer to draw, render previous frame
  601. VideoCore::g_renderer->SwapBuffers({});
  602. continue;
  603. }
  604. auto& igbp_buffer = buffer->igbp_buffer;
  605. // Now send the buffer to the GPU for drawing.
  606. auto nvdrv = NVDRV::nvdrv_a.lock();
  607. ASSERT(nvdrv);
  608. // TODO(Subv): Support more than just disp0. The display device selection is probably based
  609. // on which display we're drawing (Default, Internal, External, etc)
  610. auto nvdisp = nvdrv->GetDevice<NVDRV::Devices::nvdisp_disp0>("/dev/nvdisp_disp0");
  611. ASSERT(nvdisp);
  612. nvdisp->flip(igbp_buffer.gpu_buffer_id, igbp_buffer.offset, igbp_buffer.format,
  613. igbp_buffer.width, igbp_buffer.height, igbp_buffer.stride);
  614. buffer_queue->ReleaseBuffer(buffer->slot);
  615. }
  616. }
  617. BufferQueue::BufferQueue(u32 id, u64 layer_id) : id(id), layer_id(layer_id) {}
  618. void BufferQueue::SetPreallocatedBuffer(u32 slot, IGBPBuffer& igbp_buffer) {
  619. Buffer buffer{};
  620. buffer.slot = slot;
  621. buffer.igbp_buffer = igbp_buffer;
  622. buffer.status = Buffer::Status::Free;
  623. LOG_WARNING(Service, "Adding graphics buffer %u", slot);
  624. queue.emplace_back(buffer);
  625. }
  626. u32 BufferQueue::DequeueBuffer(u32 pixel_format, u32 width, u32 height) {
  627. auto itr = std::find_if(queue.begin(), queue.end(), [&](const Buffer& buffer) {
  628. // Only consider free buffers. Buffers become free once again after they've been Acquired
  629. // and Released by the compositor, see the NVFlinger::Compose method.
  630. if (buffer.status != Buffer::Status::Free)
  631. return false;
  632. // Make sure that the parameters match.
  633. auto& igbp_buffer = buffer.igbp_buffer;
  634. return igbp_buffer.format == pixel_format && igbp_buffer.width == width &&
  635. igbp_buffer.height == height;
  636. });
  637. ASSERT(itr != queue.end());
  638. itr->status = Buffer::Status::Dequeued;
  639. return itr->slot;
  640. }
  641. const IGBPBuffer& BufferQueue::RequestBuffer(u32 slot) const {
  642. auto itr = std::find_if(queue.begin(), queue.end(),
  643. [&](const Buffer& buffer) { return buffer.slot == slot; });
  644. ASSERT(itr != queue.end());
  645. ASSERT(itr->status == Buffer::Status::Dequeued);
  646. return itr->igbp_buffer;
  647. }
  648. void BufferQueue::QueueBuffer(u32 slot) {
  649. auto itr = std::find_if(queue.begin(), queue.end(),
  650. [&](const Buffer& buffer) { return buffer.slot == slot; });
  651. ASSERT(itr != queue.end());
  652. ASSERT(itr->status == Buffer::Status::Dequeued);
  653. itr->status = Buffer::Status::Queued;
  654. }
  655. boost::optional<const BufferQueue::Buffer&> BufferQueue::AcquireBuffer() {
  656. auto itr = std::find_if(queue.begin(), queue.end(), [](const Buffer& buffer) {
  657. return buffer.status == Buffer::Status::Queued;
  658. });
  659. if (itr == queue.end())
  660. return boost::none;
  661. itr->status = Buffer::Status::Acquired;
  662. return *itr;
  663. }
  664. void BufferQueue::ReleaseBuffer(u32 slot) {
  665. auto itr = std::find_if(queue.begin(), queue.end(),
  666. [&](const Buffer& buffer) { return buffer.slot == slot; });
  667. ASSERT(itr != queue.end());
  668. ASSERT(itr->status == Buffer::Status::Acquired);
  669. itr->status = Buffer::Status::Free;
  670. }
  671. Layer::Layer(u64 id, std::shared_ptr<BufferQueue> queue) : id(id), buffer_queue(std::move(queue)) {}
  672. Display::Display(u64 id, std::string name) : id(id), name(std::move(name)) {
  673. vsync_event = Kernel::Event::Create(Kernel::ResetType::Pulse, "Display VSync Event");
  674. }
  675. } // namespace VI
  676. } // namespace Service