synx.c 65 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2019-2021, The Linux Foundation. All rights reserved.
  4. * Copyright (c) 2022-2023, Qualcomm Innovation Center, Inc. All rights reserved.
  5. */
  6. #include <linux/atomic.h>
  7. #include <linux/file.h>
  8. #include <linux/fs.h>
  9. #include <linux/module.h>
  10. #include <linux/poll.h>
  11. #include <linux/random.h>
  12. #include <linux/remoteproc/qcom_rproc.h>
  13. #include <linux/slab.h>
  14. #include <linux/sync_file.h>
  15. #include <linux/uaccess.h>
  16. #include <linux/vmalloc.h>
  17. #include "synx_debugfs.h"
  18. #include "synx_private.h"
  19. #include "synx_util.h"
  20. struct synx_device *synx_dev;
  21. static atomic64_t synx_counter = ATOMIC64_INIT(1);
  22. void synx_external_callback(s32 sync_obj, int status, void *data)
  23. {
  24. struct synx_signal_cb *signal_cb = data;
  25. if (IS_ERR_OR_NULL(signal_cb)) {
  26. dprintk(SYNX_ERR,
  27. "invalid payload from external obj %d [%d]\n",
  28. sync_obj, status);
  29. return;
  30. }
  31. signal_cb->status = status;
  32. signal_cb->ext_sync_id = sync_obj;
  33. signal_cb->flag = SYNX_SIGNAL_FROM_CALLBACK;
  34. dprintk(SYNX_DBG,
  35. "external callback from %d on handle %u\n",
  36. sync_obj, signal_cb->handle);
  37. /*
  38. * invoke the handler directly as external callback
  39. * is invoked from separate task.
  40. * avoids creation of separate task again.
  41. */
  42. synx_signal_handler(&signal_cb->cb_dispatch);
  43. }
  44. EXPORT_SYMBOL(synx_external_callback);
  45. bool synx_fence_enable_signaling(struct dma_fence *fence)
  46. {
  47. return true;
  48. }
  49. const char *synx_fence_driver_name(struct dma_fence *fence)
  50. {
  51. return "Global Synx driver";
  52. }
  53. void synx_fence_release(struct dma_fence *fence)
  54. {
  55. /* release the memory allocated during create */
  56. kfree(fence->lock);
  57. kfree(fence);
  58. dprintk(SYNX_MEM, "released backing fence %pK\n", fence);
  59. }
  60. EXPORT_SYMBOL(synx_fence_release);
  61. static struct dma_fence_ops synx_fence_ops = {
  62. .wait = dma_fence_default_wait,
  63. .enable_signaling = synx_fence_enable_signaling,
  64. .get_driver_name = synx_fence_driver_name,
  65. .get_timeline_name = synx_fence_driver_name,
  66. .release = synx_fence_release,
  67. };
  68. static int synx_create_sync_fd(struct dma_fence *fence)
  69. {
  70. int fd;
  71. struct sync_file *sync_file;
  72. if (IS_ERR_OR_NULL(fence))
  73. return -SYNX_INVALID;
  74. fd = get_unused_fd_flags(O_CLOEXEC);
  75. if (fd < 0)
  76. return fd;
  77. sync_file = sync_file_create(fence);
  78. if (IS_ERR_OR_NULL(sync_file)) {
  79. dprintk(SYNX_ERR, "error creating sync file\n");
  80. goto err;
  81. }
  82. fd_install(fd, sync_file->file);
  83. return fd;
  84. err:
  85. put_unused_fd(fd);
  86. return -SYNX_INVALID;
  87. }
  88. void *synx_get_fence(struct synx_session *session,
  89. u32 h_synx)
  90. {
  91. struct synx_client *client;
  92. struct synx_handle_coredata *synx_data;
  93. struct synx_coredata *synx_obj;
  94. struct dma_fence *fence = NULL;
  95. client = synx_get_client(session);
  96. if (IS_ERR_OR_NULL(client))
  97. return NULL;
  98. synx_data = synx_util_acquire_handle(client, h_synx);
  99. synx_obj = synx_util_obtain_object(synx_data);
  100. if (IS_ERR_OR_NULL(synx_obj) ||
  101. IS_ERR_OR_NULL(synx_obj->fence)) {
  102. dprintk(SYNX_ERR,
  103. "[sess :%llu] invalid handle access %u\n",
  104. client->id, h_synx);
  105. goto fail;
  106. }
  107. mutex_lock(&synx_obj->obj_lock);
  108. fence = synx_obj->fence;
  109. /* obtain an additional reference to the fence */
  110. dma_fence_get(fence);
  111. mutex_unlock(&synx_obj->obj_lock);
  112. fail:
  113. synx_util_release_handle(synx_data);
  114. synx_put_client(client);
  115. return fence;
  116. }
  117. EXPORT_SYMBOL(synx_get_fence);
  118. static int synx_native_check_bind(struct synx_client *client,
  119. struct synx_create_params *params)
  120. {
  121. int rc;
  122. u32 h_synx;
  123. struct synx_entry_64 *ext_entry;
  124. struct synx_map_entry *entry;
  125. if (IS_ERR_OR_NULL(params->fence))
  126. return -SYNX_INVALID;
  127. ext_entry = synx_util_retrieve_data(params->fence,
  128. synx_util_map_params_to_type(params->flags));
  129. if (IS_ERR_OR_NULL(ext_entry))
  130. return -SYNX_NOENT;
  131. h_synx = ext_entry->data[0];
  132. synx_util_remove_data(params->fence,
  133. synx_util_map_params_to_type(params->flags));
  134. entry = synx_util_get_map_entry(h_synx);
  135. if (IS_ERR_OR_NULL(entry))
  136. /* possible cleanup, retry to alloc new handle */
  137. return -SYNX_NOENT;
  138. rc = synx_util_init_handle(client, entry->synx_obj,
  139. &h_synx, entry);
  140. if (rc != SYNX_SUCCESS) {
  141. dprintk(SYNX_ERR,
  142. "[sess :%llu] new handle init failed\n",
  143. client->id);
  144. goto fail;
  145. }
  146. *params->h_synx = h_synx;
  147. return SYNX_SUCCESS;
  148. fail:
  149. synx_util_release_map_entry(entry);
  150. return rc;
  151. }
  152. static int synx_native_create_core(struct synx_client *client,
  153. struct synx_create_params *params)
  154. {
  155. int rc;
  156. struct synx_coredata *synx_obj;
  157. struct synx_map_entry *map_entry;
  158. if (IS_ERR_OR_NULL(client) || IS_ERR_OR_NULL(params) ||
  159. IS_ERR_OR_NULL(params->h_synx))
  160. return -SYNX_INVALID;
  161. synx_obj = kzalloc(sizeof(*synx_obj), GFP_KERNEL);
  162. if (IS_ERR_OR_NULL(synx_obj))
  163. return -SYNX_NOMEM;
  164. rc = synx_util_init_coredata(synx_obj, params,
  165. &synx_fence_ops, client->dma_context);
  166. if (rc) {
  167. dprintk(SYNX_ERR,
  168. "[sess :%llu] handle allocation failed\n",
  169. client->id);
  170. kfree(synx_obj);
  171. goto fail;
  172. }
  173. map_entry = synx_util_insert_to_map(synx_obj,
  174. *params->h_synx, 0);
  175. if (IS_ERR_OR_NULL(map_entry)) {
  176. rc = PTR_ERR(map_entry);
  177. synx_util_put_object(synx_obj);
  178. goto fail;
  179. }
  180. rc = synx_util_add_callback(synx_obj, *params->h_synx);
  181. if (rc != SYNX_SUCCESS) {
  182. synx_util_release_map_entry(map_entry);
  183. goto fail;
  184. }
  185. rc = synx_util_init_handle(client, synx_obj,
  186. params->h_synx, map_entry);
  187. if (rc < 0) {
  188. dprintk(SYNX_ERR,
  189. "[sess :%llu] unable to init new handle\n",
  190. client->id);
  191. synx_util_release_map_entry(map_entry);
  192. goto fail;
  193. }
  194. dprintk(SYNX_MEM,
  195. "[sess :%llu] allocated %u, core %pK, fence %pK\n",
  196. client->id, *params->h_synx, synx_obj, synx_obj->fence);
  197. return SYNX_SUCCESS;
  198. fail:
  199. return rc;
  200. }
  201. int synx_create(struct synx_session *session,
  202. struct synx_create_params *params)
  203. {
  204. int rc = -SYNX_NOENT;
  205. struct synx_client *client;
  206. struct synx_external_desc_v2 ext_desc = {0};
  207. if (IS_ERR_OR_NULL(params) || IS_ERR_OR_NULL(params->h_synx) ||
  208. params->flags > SYNX_CREATE_MAX_FLAGS) {
  209. dprintk(SYNX_ERR, "invalid create arguments\n");
  210. return -SYNX_INVALID;
  211. }
  212. if (params->flags & SYNX_CREATE_DMA_FENCE) {
  213. dprintk(SYNX_ERR,
  214. "handle create with native fence not supported\n");
  215. return -SYNX_NOSUPPORT;
  216. }
  217. client = synx_get_client(session);
  218. if (IS_ERR_OR_NULL(client))
  219. return -SYNX_INVALID;
  220. *params->h_synx = 0;
  221. do {
  222. /* create with external fence */
  223. if (!IS_ERR_OR_NULL(params->fence))
  224. rc = synx_native_check_bind(client, params);
  225. if (rc == -SYNX_NOENT) {
  226. rc = synx_native_create_core(client, params);
  227. if (rc == SYNX_SUCCESS &&
  228. !IS_ERR_OR_NULL(params->fence)) {
  229. /* save external fence details */
  230. rc = synx_util_save_data(params->fence,
  231. synx_util_map_params_to_type(params->flags),
  232. *params->h_synx);
  233. if (rc == -SYNX_ALREADY) {
  234. /*
  235. * raced with create on same fence from
  236. * another client. clear the allocated
  237. * handle and retry.
  238. */
  239. synx_native_release_core(client, *params->h_synx);
  240. *params->h_synx = 0;
  241. rc = -SYNX_NOENT;
  242. continue;
  243. } else if (rc != SYNX_SUCCESS) {
  244. dprintk(SYNX_ERR,
  245. "allocating handle failed=%d", rc);
  246. synx_native_release_core(client, *params->h_synx);
  247. break;
  248. }
  249. /* bind with external fence */
  250. ext_desc.id = *((u32 *)params->fence);
  251. ext_desc.type = synx_util_map_params_to_type(params->flags);
  252. rc = synx_bind(session, *params->h_synx, ext_desc);
  253. if (rc != SYNX_SUCCESS) {
  254. dprintk(SYNX_ERR,
  255. "[sess :%llu] bind external fence failed\n",
  256. client->id);
  257. synx_native_release_core(client, *params->h_synx);
  258. goto fail;
  259. }
  260. }
  261. }
  262. if (rc == SYNX_SUCCESS)
  263. dprintk(SYNX_VERB,
  264. "[sess :%llu] handle allocated %u\n",
  265. client->id, *params->h_synx);
  266. break;
  267. } while (true);
  268. fail:
  269. synx_put_client(client);
  270. return rc;
  271. }
  272. EXPORT_SYMBOL(synx_create);
  273. int synx_native_signal_core(struct synx_coredata *synx_obj,
  274. u32 status,
  275. bool cb_signal,
  276. u64 ext_sync_id)
  277. {
  278. int rc = 0;
  279. int ret;
  280. u32 i = 0;
  281. u32 idx = 0;
  282. s32 sync_id;
  283. u32 type;
  284. void *data = NULL;
  285. struct synx_bind_desc bind_descs[SYNX_MAX_NUM_BINDINGS];
  286. struct bind_operations *bind_ops = NULL;
  287. if (IS_ERR_OR_NULL(synx_obj))
  288. return -SYNX_INVALID;
  289. synx_util_callback_dispatch(synx_obj, status);
  290. /*
  291. * signal the external bound sync obj/s even if fence signal fails,
  292. * w/ error signal state (set above) to prevent deadlock
  293. */
  294. if (synx_obj->num_bound_synxs > 0) {
  295. memset(bind_descs, 0,
  296. sizeof(struct synx_bind_desc) * SYNX_MAX_NUM_BINDINGS);
  297. for (i = 0; i < synx_obj->num_bound_synxs; i++) {
  298. /* signal invoked by external sync obj */
  299. if (cb_signal &&
  300. (ext_sync_id ==
  301. synx_obj->bound_synxs[i].external_desc.id)) {
  302. dprintk(SYNX_VERB,
  303. "skipping signaling inbound sync: %llu\n",
  304. ext_sync_id);
  305. type = synx_obj->bound_synxs[i].external_desc.type;
  306. memset(&synx_obj->bound_synxs[i], 0,
  307. sizeof(struct synx_bind_desc));
  308. /* clear the hash table entry */
  309. synx_util_remove_data(&ext_sync_id, type);
  310. continue;
  311. }
  312. memcpy(&bind_descs[idx++],
  313. &synx_obj->bound_synxs[i],
  314. sizeof(struct synx_bind_desc));
  315. /* clear the memory, its been backed up above */
  316. memset(&synx_obj->bound_synxs[i], 0,
  317. sizeof(struct synx_bind_desc));
  318. }
  319. synx_obj->num_bound_synxs = 0;
  320. }
  321. for (i = 0; i < idx; i++) {
  322. sync_id = bind_descs[i].external_desc.id;
  323. data = bind_descs[i].external_data;
  324. type = bind_descs[i].external_desc.type;
  325. bind_ops = synx_util_get_bind_ops(type);
  326. if (IS_ERR_OR_NULL(bind_ops)) {
  327. dprintk(SYNX_ERR,
  328. "invalid bind ops for type: %u\n", type);
  329. kfree(data);
  330. continue;
  331. }
  332. /* clear the hash table entry */
  333. synx_util_remove_data(&sync_id, type);
  334. /*
  335. * we are already signaled, so don't want to
  336. * recursively be signaled
  337. */
  338. ret = bind_ops->deregister_callback(
  339. synx_external_callback, data, sync_id);
  340. if (ret < 0) {
  341. dprintk(SYNX_ERR,
  342. "deregistration fail on %d, type: %u, err=%d\n",
  343. sync_id, type, ret);
  344. continue;
  345. }
  346. dprintk(SYNX_VERB,
  347. "signal external sync: %d, type: %u, status: %u\n",
  348. sync_id, type, status);
  349. /* optional function to enable external signaling */
  350. if (bind_ops->enable_signaling) {
  351. ret = bind_ops->enable_signaling(sync_id);
  352. if (ret < 0)
  353. dprintk(SYNX_ERR,
  354. "enabling fail on %d, type: %u, err=%d\n",
  355. sync_id, type, ret);
  356. }
  357. ret = bind_ops->signal(sync_id, status);
  358. if (ret < 0)
  359. dprintk(SYNX_ERR,
  360. "signaling fail on %d, type: %u, err=%d\n",
  361. sync_id, type, ret);
  362. /*
  363. * release the memory allocated for external data.
  364. * It is safe to release this memory as external cb
  365. * has been already deregistered before this.
  366. */
  367. kfree(data);
  368. }
  369. return rc;
  370. }
  371. int synx_native_signal_fence(struct synx_coredata *synx_obj,
  372. u32 status)
  373. {
  374. int rc = 0;
  375. unsigned long flags;
  376. if (IS_ERR_OR_NULL(synx_obj) || IS_ERR_OR_NULL(synx_obj->fence))
  377. return -SYNX_INVALID;
  378. if (status <= SYNX_STATE_ACTIVE) {
  379. dprintk(SYNX_ERR, "signaling with wrong status: %u\n",
  380. status);
  381. return -SYNX_INVALID;
  382. }
  383. if (synx_util_is_merged_object(synx_obj)) {
  384. dprintk(SYNX_ERR, "signaling a composite handle\n");
  385. return -SYNX_INVALID;
  386. }
  387. if (synx_util_get_object_status(synx_obj) !=
  388. SYNX_STATE_ACTIVE)
  389. return -SYNX_ALREADY;
  390. if (IS_ERR_OR_NULL(synx_obj->signal_cb)) {
  391. dprintk(SYNX_ERR, "signal cb in bad state\n");
  392. return -SYNX_INVALID;
  393. }
  394. /*
  395. * remove registered callback for the fence
  396. * so it does not invoke the signal through callback again
  397. */
  398. if (!dma_fence_remove_callback(synx_obj->fence,
  399. &synx_obj->signal_cb->fence_cb)) {
  400. dprintk(SYNX_ERR, "callback could not be removed\n");
  401. return -SYNX_INVALID;
  402. }
  403. dprintk(SYNX_MEM, "signal cb destroyed %pK\n",
  404. synx_obj->signal_cb);
  405. kfree(synx_obj->signal_cb);
  406. synx_obj->signal_cb = NULL;
  407. /* releasing reference held by signal cb */
  408. synx_util_put_object(synx_obj);
  409. spin_lock_irqsave(synx_obj->fence->lock, flags);
  410. /* check the status again acquiring lock to avoid errors */
  411. if (synx_util_get_object_status_locked(synx_obj) !=
  412. SYNX_STATE_ACTIVE) {
  413. spin_unlock_irqrestore(synx_obj->fence->lock, flags);
  414. return -SYNX_ALREADY;
  415. }
  416. /* set fence error to model {signal w/ error} */
  417. if (status != SYNX_STATE_SIGNALED_SUCCESS)
  418. dma_fence_set_error(synx_obj->fence, -status);
  419. rc = dma_fence_signal_locked(synx_obj->fence);
  420. if (rc)
  421. dprintk(SYNX_ERR,
  422. "signaling fence %pK failed=%d\n",
  423. synx_obj->fence, rc);
  424. spin_unlock_irqrestore(synx_obj->fence->lock, flags);
  425. return rc;
  426. }
  427. void synx_signal_handler(struct work_struct *cb_dispatch)
  428. {
  429. int rc = SYNX_SUCCESS;
  430. u32 idx;
  431. struct synx_signal_cb *signal_cb =
  432. container_of(cb_dispatch, struct synx_signal_cb, cb_dispatch);
  433. struct synx_coredata *synx_obj = signal_cb->synx_obj;
  434. u32 h_synx = signal_cb->handle;
  435. u32 status = signal_cb->status;
  436. if ((signal_cb->flag & SYNX_SIGNAL_FROM_FENCE) &&
  437. (synx_util_is_global_handle(h_synx) ||
  438. synx_util_is_global_object(synx_obj))) {
  439. idx = (IS_ERR_OR_NULL(synx_obj)) ?
  440. synx_util_global_idx(h_synx) :
  441. synx_obj->global_idx;
  442. rc = synx_global_update_status(idx, status);
  443. if (rc != SYNX_SUCCESS)
  444. dprintk(SYNX_ERR,
  445. "global status update of %u failed=%d\n",
  446. h_synx, rc);
  447. /*
  448. * We are decrementing the reference here assuming this code will be
  449. * executed after handle is released. But in case if clients signal
  450. * dma fence in middle of execution sequence, then we will put
  451. * one reference thus deleting the global idx. As of now clients cannot
  452. * signal dma fence.
  453. */
  454. synx_global_put_ref(idx);
  455. }
  456. /*
  457. * when invoked from external callback, possible for
  458. * all local clients to have released the handle coredata.
  459. */
  460. if (IS_ERR_OR_NULL(synx_obj)) {
  461. dprintk(SYNX_WARN,
  462. "handle %d has no local clients\n",
  463. h_synx);
  464. dprintk(SYNX_MEM, "signal cb destroyed %pK\n",
  465. signal_cb);
  466. kfree(signal_cb);
  467. return;
  468. }
  469. if (rc != SYNX_SUCCESS) {
  470. dprintk(SYNX_ERR,
  471. "global status update for %u failed=%d\n",
  472. h_synx, rc);
  473. goto fail;
  474. }
  475. mutex_lock(&synx_obj->obj_lock);
  476. if (signal_cb->flag & SYNX_SIGNAL_FROM_IPC)
  477. rc = synx_native_signal_fence(synx_obj, status);
  478. if (rc == SYNX_SUCCESS)
  479. rc = synx_native_signal_core(synx_obj, status,
  480. (signal_cb->flag & SYNX_SIGNAL_FROM_CALLBACK) ?
  481. true : false, signal_cb->ext_sync_id);
  482. mutex_unlock(&synx_obj->obj_lock);
  483. if (rc != SYNX_SUCCESS)
  484. dprintk(SYNX_ERR,
  485. "internal signaling %u failed=%d",
  486. h_synx, rc);
  487. fail:
  488. /* release reference held by signal cb */
  489. synx_util_put_object(synx_obj);
  490. dprintk(SYNX_MEM, "signal cb destroyed %pK\n", signal_cb);
  491. kfree(signal_cb);
  492. dprintk(SYNX_VERB, "signal handle %u dispatch complete=%d",
  493. h_synx, rc);
  494. }
  495. /* function would be called from atomic context */
  496. void synx_fence_callback(struct dma_fence *fence,
  497. struct dma_fence_cb *cb)
  498. {
  499. s32 status;
  500. struct synx_signal_cb *signal_cb =
  501. container_of(cb, struct synx_signal_cb, fence_cb);
  502. dprintk(SYNX_DBG,
  503. "callback from external fence %pK for handle %u\n",
  504. fence, signal_cb->handle);
  505. /* other signal_cb members would be set during cb registration */
  506. status = dma_fence_get_status_locked(fence);
  507. /*
  508. * dma_fence_get_status_locked API returns 1 if signaled,
  509. * 0 if ACTIVE,
  510. * and negative error code in case of any failure
  511. */
  512. if (status == 1)
  513. status = SYNX_STATE_SIGNALED_SUCCESS;
  514. else if (status < 0)
  515. status = SYNX_STATE_SIGNALED_EXTERNAL;
  516. signal_cb->status = status;
  517. INIT_WORK(&signal_cb->cb_dispatch, synx_signal_handler);
  518. queue_work(synx_dev->wq_cb, &signal_cb->cb_dispatch);
  519. }
  520. EXPORT_SYMBOL(synx_fence_callback);
  521. static int synx_signal_offload_job(
  522. struct synx_client *client,
  523. struct synx_coredata *synx_obj,
  524. u32 h_synx, u32 status)
  525. {
  526. int rc = SYNX_SUCCESS;
  527. struct synx_signal_cb *signal_cb;
  528. signal_cb = kzalloc(sizeof(*signal_cb), GFP_ATOMIC);
  529. if (IS_ERR_OR_NULL(signal_cb)) {
  530. rc = -SYNX_NOMEM;
  531. goto fail;
  532. }
  533. /*
  534. * since the signal will be queued to separate thread,
  535. * to ensure the synx coredata pointer remain valid, get
  536. * additional reference, thus avoiding any potential
  537. * use-after-free.
  538. */
  539. synx_util_get_object(synx_obj);
  540. signal_cb->handle = h_synx;
  541. signal_cb->status = status;
  542. signal_cb->synx_obj = synx_obj;
  543. signal_cb->flag = SYNX_SIGNAL_FROM_CLIENT;
  544. dprintk(SYNX_VERB,
  545. "[sess :%llu] signal work queued for %u\n",
  546. client->id, h_synx);
  547. INIT_WORK(&signal_cb->cb_dispatch, synx_signal_handler);
  548. queue_work(synx_dev->wq_cb, &signal_cb->cb_dispatch);
  549. fail:
  550. return rc;
  551. }
  552. int synx_signal(struct synx_session *session, u32 h_synx, u32 status)
  553. {
  554. int rc = SYNX_SUCCESS;
  555. struct synx_client *client;
  556. struct synx_handle_coredata *synx_data = NULL;
  557. struct synx_coredata *synx_obj;
  558. client = synx_get_client(session);
  559. if (IS_ERR_OR_NULL(client))
  560. return -SYNX_INVALID;
  561. if (status <= SYNX_STATE_ACTIVE) {
  562. dprintk(SYNX_ERR,
  563. "[sess :%llu] signaling with wrong status: %u\n",
  564. client->id, status);
  565. rc = -SYNX_INVALID;
  566. goto fail;
  567. }
  568. synx_data = synx_util_acquire_handle(client, h_synx);
  569. synx_obj = synx_util_obtain_object(synx_data);
  570. if (IS_ERR_OR_NULL(synx_obj) ||
  571. IS_ERR_OR_NULL(synx_obj->fence)) {
  572. dprintk(SYNX_ERR,
  573. "[sess :%llu] invalid handle access %u\n",
  574. client->id, h_synx);
  575. rc = -SYNX_INVALID;
  576. goto fail;
  577. }
  578. if (synx_util_is_global_handle(h_synx) ||
  579. synx_util_is_global_object(synx_obj))
  580. rc = synx_global_update_status(
  581. synx_obj->global_idx, status);
  582. if (rc != SYNX_SUCCESS) {
  583. dprintk(SYNX_ERR,
  584. "[sess :%llu] status update %d failed=%d\n",
  585. client->id, h_synx, rc);
  586. goto fail;
  587. }
  588. /*
  589. * offload callback dispatch and external fence
  590. * notification to separate worker thread, if any.
  591. */
  592. if (synx_obj->num_bound_synxs ||
  593. !list_empty(&synx_obj->reg_cbs_list))
  594. rc = synx_signal_offload_job(client, synx_obj,
  595. h_synx, status);
  596. mutex_lock(&synx_obj->obj_lock);
  597. rc = synx_native_signal_fence(synx_obj, status);
  598. if (rc != SYNX_SUCCESS)
  599. dprintk(SYNX_ERR,
  600. "[sess :%llu] signaling %u failed=%d\n",
  601. client->id, h_synx, rc);
  602. mutex_unlock(&synx_obj->obj_lock);
  603. fail:
  604. synx_util_release_handle(synx_data);
  605. synx_put_client(client);
  606. return rc;
  607. }
  608. EXPORT_SYMBOL(synx_signal);
  609. static int synx_match_payload(struct synx_kernel_payload *cb_payload,
  610. struct synx_kernel_payload *payload)
  611. {
  612. int rc = 0;
  613. if (IS_ERR_OR_NULL(cb_payload) || IS_ERR_OR_NULL(payload))
  614. return -SYNX_INVALID;
  615. if ((cb_payload->cb_func == payload->cb_func) &&
  616. (cb_payload->data == payload->data)) {
  617. if (payload->cancel_cb_func) {
  618. cb_payload->cb_func =
  619. payload->cancel_cb_func;
  620. rc = 1;
  621. } else {
  622. rc = 2;
  623. dprintk(SYNX_VERB,
  624. "kernel cb de-registration success\n");
  625. }
  626. }
  627. return rc;
  628. }
  629. int synx_async_wait(struct synx_session *session,
  630. struct synx_callback_params *params)
  631. {
  632. int rc = 0;
  633. u32 idx;
  634. u32 status;
  635. struct synx_client *client;
  636. struct synx_handle_coredata *synx_data;
  637. struct synx_coredata *synx_obj;
  638. struct synx_cb_data *synx_cb;
  639. struct synx_kernel_payload payload;
  640. if (IS_ERR_OR_NULL(session) || IS_ERR_OR_NULL(params))
  641. return -SYNX_INVALID;
  642. client = synx_get_client(session);
  643. if (IS_ERR_OR_NULL(client))
  644. return -SYNX_INVALID;
  645. synx_data = synx_util_acquire_handle(client, params->h_synx);
  646. synx_obj = synx_util_obtain_object(synx_data);
  647. if (IS_ERR_OR_NULL(synx_obj)) {
  648. dprintk(SYNX_ERR,
  649. "[sess :%llu] invalid handle access %u\n",
  650. client->id, params->h_synx);
  651. rc = -SYNX_INVALID;
  652. goto fail;
  653. }
  654. mutex_lock(&synx_obj->obj_lock);
  655. if (synx_util_is_merged_object(synx_obj)) {
  656. dprintk(SYNX_ERR,
  657. "[sess :%llu] cannot async wait on merged handle %u\n",
  658. client->id, params->h_synx);
  659. rc = -SYNX_INVALID;
  660. goto release;
  661. }
  662. synx_cb = kzalloc(sizeof(*synx_cb), GFP_ATOMIC);
  663. if (IS_ERR_OR_NULL(synx_cb)) {
  664. rc = -SYNX_NOMEM;
  665. goto release;
  666. }
  667. payload.h_synx = params->h_synx;
  668. payload.cb_func = params->cb_func;
  669. payload.data = params->userdata;
  670. /* allocate a free index from client cb table */
  671. rc = synx_util_alloc_cb_entry(client, &payload, &idx);
  672. if (rc) {
  673. dprintk(SYNX_ERR,
  674. "[sess :%llu] error allocating cb entry\n",
  675. client->id);
  676. kfree(synx_cb);
  677. goto release;
  678. }
  679. if (synx_util_is_global_handle(params->h_synx) ||
  680. synx_util_is_global_object(synx_obj))
  681. status = synx_global_test_status_set_wait(
  682. synx_util_global_idx(params->h_synx),
  683. SYNX_CORE_APSS);
  684. else
  685. status = synx_util_get_object_status(synx_obj);
  686. synx_cb->session = session;
  687. synx_cb->idx = idx;
  688. INIT_WORK(&synx_cb->cb_dispatch, synx_util_cb_dispatch);
  689. /* add callback if object still ACTIVE, dispatch if SIGNALED */
  690. if (status == SYNX_STATE_ACTIVE) {
  691. dprintk(SYNX_VERB,
  692. "[sess :%llu] callback added for handle %u\n",
  693. client->id, params->h_synx);
  694. list_add(&synx_cb->node, &synx_obj->reg_cbs_list);
  695. } else {
  696. synx_cb->status = status;
  697. dprintk(SYNX_VERB,
  698. "[sess :%llu] callback queued for handle %u\n",
  699. client->id, params->h_synx);
  700. queue_work(synx_dev->wq_cb,
  701. &synx_cb->cb_dispatch);
  702. }
  703. release:
  704. mutex_unlock(&synx_obj->obj_lock);
  705. fail:
  706. synx_util_release_handle(synx_data);
  707. synx_put_client(client);
  708. return rc;
  709. }
  710. EXPORT_SYMBOL(synx_async_wait);
  711. int synx_cancel_async_wait(
  712. struct synx_session *session,
  713. struct synx_callback_params *params)
  714. {
  715. int rc = 0, ret = 0;
  716. u32 status;
  717. bool match_found = false;
  718. struct synx_client *client;
  719. struct synx_handle_coredata *synx_data;
  720. struct synx_coredata *synx_obj;
  721. struct synx_kernel_payload payload;
  722. struct synx_cb_data *synx_cb, *synx_cb_temp;
  723. struct synx_client_cb *cb_payload;
  724. if (IS_ERR_OR_NULL(session) || IS_ERR_OR_NULL(params))
  725. return -SYNX_INVALID;
  726. client = synx_get_client(session);
  727. if (IS_ERR_OR_NULL(client))
  728. return -SYNX_INVALID;
  729. synx_data = synx_util_acquire_handle(client, params->h_synx);
  730. synx_obj = synx_util_obtain_object(synx_data);
  731. if (IS_ERR_OR_NULL(synx_obj)) {
  732. dprintk(SYNX_ERR,
  733. "[sess :%llu] invalid handle access %u\n",
  734. client->id, params->h_synx);
  735. rc = -SYNX_INVALID;
  736. goto fail;
  737. }
  738. mutex_lock(&synx_obj->obj_lock);
  739. if (synx_util_is_merged_object(synx_obj) ||
  740. synx_util_is_external_object(synx_obj)) {
  741. dprintk(SYNX_ERR,
  742. "cannot cancel wait on composite handle\n");
  743. goto release;
  744. }
  745. payload.h_synx = params->h_synx;
  746. payload.cb_func = params->cb_func;
  747. payload.data = params->userdata;
  748. payload.cancel_cb_func = params->cancel_cb_func;
  749. status = synx_util_get_object_status(synx_obj);
  750. if (status != SYNX_STATE_ACTIVE) {
  751. dprintk(SYNX_ERR,
  752. "handle %u already signaled cannot cancel\n",
  753. params->h_synx);
  754. rc = -SYNX_INVALID;
  755. goto release;
  756. }
  757. status = SYNX_CALLBACK_RESULT_CANCELED;
  758. /* remove all cb payloads mayching the deregister call */
  759. list_for_each_entry_safe(synx_cb, synx_cb_temp,
  760. &synx_obj->reg_cbs_list, node) {
  761. if (synx_cb->session != session) {
  762. continue;
  763. } else if (synx_cb->idx == 0 ||
  764. synx_cb->idx >= SYNX_MAX_OBJS) {
  765. /*
  766. * this should not happen. Even if it does,
  767. * the allocated memory will be cleaned up
  768. * when object is destroyed, preventing any
  769. * memory leaks.
  770. */
  771. dprintk(SYNX_ERR,
  772. "[sess :%llu] invalid callback data\n",
  773. client->id);
  774. continue;
  775. }
  776. cb_payload = &client->cb_table[synx_cb->idx];
  777. ret = synx_match_payload(&cb_payload->kernel_cb, &payload);
  778. switch (ret) {
  779. case 1:
  780. /* queue the cancel cb work */
  781. list_del_init(&synx_cb->node);
  782. synx_cb->status = status;
  783. queue_work(synx_dev->wq_cb,
  784. &synx_cb->cb_dispatch);
  785. match_found = true;
  786. break;
  787. case 2:
  788. /* no cancellation cb */
  789. if (synx_util_clear_cb_entry(client, cb_payload))
  790. dprintk(SYNX_ERR,
  791. "[sess :%llu] error clearing cb %u\n",
  792. client->id, params->h_synx);
  793. list_del_init(&synx_cb->node);
  794. kfree(synx_cb);
  795. match_found = true;
  796. break;
  797. default:
  798. break;
  799. }
  800. }
  801. if (!match_found)
  802. rc = -SYNX_INVALID;
  803. release:
  804. mutex_unlock(&synx_obj->obj_lock);
  805. fail:
  806. synx_util_release_handle(synx_data);
  807. synx_put_client(client);
  808. return rc;
  809. }
  810. EXPORT_SYMBOL(synx_cancel_async_wait);
  811. int synx_merge(struct synx_session *session,
  812. struct synx_merge_params *params)
  813. {
  814. int rc, i, j = 0;
  815. u32 h_child;
  816. u32 count = 0;
  817. u32 *h_child_list;
  818. struct synx_client *client;
  819. struct dma_fence **fences = NULL;
  820. struct synx_coredata *synx_obj;
  821. struct synx_map_entry *map_entry;
  822. if (IS_ERR_OR_NULL(session) || IS_ERR_OR_NULL(params))
  823. return -SYNX_INVALID;
  824. if (IS_ERR_OR_NULL(params->h_synxs) ||
  825. IS_ERR_OR_NULL(params->h_merged_obj)) {
  826. dprintk(SYNX_ERR, "invalid arguments\n");
  827. return -SYNX_INVALID;
  828. }
  829. client = synx_get_client(session);
  830. if (IS_ERR_OR_NULL(client))
  831. return -SYNX_INVALID;
  832. rc = synx_util_validate_merge(client, params->h_synxs,
  833. params->num_objs, &fences, &count);
  834. if (rc < 0) {
  835. dprintk(SYNX_ERR,
  836. "[sess :%llu] merge validation failed\n",
  837. client->id);
  838. rc = -SYNX_INVALID;
  839. goto fail;
  840. }
  841. synx_obj = kzalloc(sizeof(*synx_obj), GFP_KERNEL);
  842. if (IS_ERR_OR_NULL(synx_obj)) {
  843. rc = -SYNX_NOMEM;
  844. goto fail;
  845. }
  846. rc = synx_util_init_group_coredata(synx_obj, fences,
  847. params, count, client->dma_context);
  848. if (rc) {
  849. dprintk(SYNX_ERR,
  850. "[sess :%llu] error initializing merge handle\n",
  851. client->id);
  852. goto clean_up;
  853. }
  854. map_entry = synx_util_insert_to_map(synx_obj,
  855. *params->h_merged_obj, 0);
  856. if (IS_ERR_OR_NULL(map_entry)) {
  857. rc = PTR_ERR(map_entry);
  858. goto clean_up;
  859. }
  860. rc = synx_util_init_handle(client, synx_obj,
  861. params->h_merged_obj, map_entry);
  862. if (rc) {
  863. dprintk(SYNX_ERR,
  864. "[sess :%llu] unable to init merge handle %u\n",
  865. client->id, *params->h_merged_obj);
  866. dma_fence_put(synx_obj->fence);
  867. goto clear;
  868. }
  869. if (params->flags & SYNX_MERGE_GLOBAL_FENCE) {
  870. h_child_list = kzalloc(count*4, GFP_KERNEL);
  871. if (IS_ERR_OR_NULL(synx_obj)) {
  872. rc = -SYNX_NOMEM;
  873. goto clear;
  874. }
  875. for (i = 0; i < count; i++) {
  876. h_child = synx_util_get_fence_entry((u64)fences[i], 1);
  877. if (!synx_util_is_global_handle(h_child))
  878. continue;
  879. h_child_list[j++] = synx_util_global_idx(h_child);
  880. }
  881. rc = synx_global_merge(h_child_list, j,
  882. synx_util_global_idx(*params->h_merged_obj));
  883. if (rc != SYNX_SUCCESS) {
  884. dprintk(SYNX_ERR, "global merge failed\n");
  885. goto clear;
  886. }
  887. }
  888. dprintk(SYNX_MEM,
  889. "[sess :%llu] merge allocated %u, core %pK, fence %pK\n",
  890. client->id, *params->h_merged_obj, synx_obj,
  891. synx_obj->fence);
  892. synx_put_client(client);
  893. return SYNX_SUCCESS;
  894. clear:
  895. synx_util_release_map_entry(map_entry);
  896. clean_up:
  897. kfree(synx_obj);
  898. fail:
  899. synx_util_merge_error(client, params->h_synxs, count);
  900. if (params->num_objs && params->num_objs <= count)
  901. kfree(fences);
  902. synx_put_client(client);
  903. return rc;
  904. }
  905. EXPORT_SYMBOL(synx_merge);
  906. int synx_native_release_core(struct synx_client *client,
  907. u32 h_synx)
  908. {
  909. int rc = -SYNX_INVALID;
  910. struct synx_handle_coredata *curr, *synx_handle = NULL;
  911. spin_lock_bh(&client->handle_map_lock);
  912. hash_for_each_possible(client->handle_map,
  913. curr, node, h_synx) {
  914. if (curr->key == h_synx &&
  915. curr->rel_count != 0) {
  916. curr->rel_count--;
  917. synx_handle = curr;
  918. rc = SYNX_SUCCESS;
  919. break;
  920. }
  921. }
  922. spin_unlock_bh(&client->handle_map_lock);
  923. /* release the reference obtained at synx creation */
  924. synx_util_release_handle(synx_handle);
  925. return rc;
  926. }
  927. int synx_release(struct synx_session *session, u32 h_synx)
  928. {
  929. int rc = 0;
  930. struct synx_client *client;
  931. client = synx_get_client(session);
  932. if (IS_ERR_OR_NULL(client))
  933. return -SYNX_INVALID;
  934. rc = synx_native_release_core(client, h_synx);
  935. synx_put_client(client);
  936. return rc;
  937. }
  938. EXPORT_SYMBOL(synx_release);
  939. int synx_wait(struct synx_session *session,
  940. u32 h_synx, u64 timeout_ms)
  941. {
  942. int rc = 0;
  943. unsigned long timeleft;
  944. struct synx_client *client;
  945. struct synx_handle_coredata *synx_data;
  946. struct synx_coredata *synx_obj;
  947. client = synx_get_client(session);
  948. if (IS_ERR_OR_NULL(client))
  949. return -SYNX_INVALID;
  950. synx_data = synx_util_acquire_handle(client, h_synx);
  951. synx_obj = synx_util_obtain_object(synx_data);
  952. if (IS_ERR_OR_NULL(synx_obj) || IS_ERR_OR_NULL(synx_obj->fence)) {
  953. dprintk(SYNX_ERR,
  954. "[sess :%llu] invalid handle access %u\n",
  955. client->id, h_synx);
  956. rc = -SYNX_INVALID;
  957. goto fail;
  958. }
  959. if (synx_util_is_global_handle(h_synx)) {
  960. rc = synx_global_test_status_set_wait(
  961. synx_util_global_idx(h_synx), SYNX_CORE_APSS);
  962. if (rc != SYNX_STATE_ACTIVE)
  963. goto fail;
  964. }
  965. timeleft = dma_fence_wait_timeout(synx_obj->fence, (bool) 0,
  966. msecs_to_jiffies(timeout_ms));
  967. if (timeleft <= 0) {
  968. dprintk(SYNX_ERR,
  969. "[sess :%llu] wait timeout for handle %u\n",
  970. client->id, h_synx);
  971. rc = -ETIMEDOUT;
  972. goto fail;
  973. }
  974. mutex_lock(&synx_obj->obj_lock);
  975. rc = synx_util_get_object_status(synx_obj);
  976. mutex_unlock(&synx_obj->obj_lock);
  977. fail:
  978. synx_util_release_handle(synx_data);
  979. synx_put_client(client);
  980. return rc;
  981. }
  982. EXPORT_SYMBOL(synx_wait);
  983. int synx_bind(struct synx_session *session,
  984. u32 h_synx,
  985. struct synx_external_desc_v2 external_sync)
  986. {
  987. int rc = 0;
  988. u32 i;
  989. u32 bound_idx;
  990. struct synx_client *client;
  991. struct synx_handle_coredata *synx_data = NULL;
  992. struct synx_coredata *synx_obj;
  993. struct synx_signal_cb *data = NULL;
  994. struct bind_operations *bind_ops = NULL;
  995. client = synx_get_client(session);
  996. if (IS_ERR_OR_NULL(client))
  997. return -SYNX_INVALID;
  998. synx_data = synx_util_acquire_handle(client, h_synx);
  999. synx_obj = synx_util_obtain_object(synx_data);
  1000. if (IS_ERR_OR_NULL(synx_obj)) {
  1001. if (rc || synx_data)
  1002. dprintk(SYNX_ERR,
  1003. "[sess :%llu] invalid handle access %u\n",
  1004. client->id, h_synx);
  1005. goto fail;
  1006. }
  1007. bind_ops = synx_util_get_bind_ops(external_sync.type);
  1008. if (IS_ERR_OR_NULL(bind_ops)) {
  1009. dprintk(SYNX_ERR,
  1010. "[sess :%llu] invalid bind ops for %u\n",
  1011. client->id, external_sync.type);
  1012. rc = -SYNX_INVALID;
  1013. goto fail;
  1014. }
  1015. mutex_lock(&synx_obj->obj_lock);
  1016. if (synx_util_is_merged_object(synx_obj)) {
  1017. dprintk(SYNX_ERR,
  1018. "[sess :%llu] cannot bind to composite handle %u\n",
  1019. client->id, h_synx);
  1020. rc = -SYNX_INVALID;
  1021. goto release;
  1022. }
  1023. if (synx_obj->num_bound_synxs >= SYNX_MAX_NUM_BINDINGS) {
  1024. dprintk(SYNX_ERR,
  1025. "[sess :%llu] max bindings reached for handle %u\n",
  1026. client->id, h_synx);
  1027. rc = -SYNX_NOMEM;
  1028. goto release;
  1029. }
  1030. /* don't bind external sync obj if already done */
  1031. for (i = 0; i < synx_obj->num_bound_synxs; i++) {
  1032. if ((external_sync.id ==
  1033. synx_obj->bound_synxs[i].external_desc.id) &&
  1034. (external_sync.type ==
  1035. synx_obj->bound_synxs[i].external_desc.type)){
  1036. dprintk(SYNX_ERR,
  1037. "[sess :%llu] duplicate bind for sync %llu\n",
  1038. client->id, external_sync.id);
  1039. rc = -SYNX_ALREADY;
  1040. goto release;
  1041. }
  1042. }
  1043. data = kzalloc(sizeof(*data), GFP_KERNEL);
  1044. if (IS_ERR_OR_NULL(data)) {
  1045. rc = -SYNX_NOMEM;
  1046. goto release;
  1047. }
  1048. /* get additional reference since passing pointer to cb */
  1049. synx_util_get_object(synx_obj);
  1050. /* data passed to external callback */
  1051. data->handle = h_synx;
  1052. data->synx_obj = synx_obj;
  1053. bound_idx = synx_obj->num_bound_synxs;
  1054. memcpy(&synx_obj->bound_synxs[bound_idx],
  1055. &external_sync, sizeof(struct synx_external_desc_v2));
  1056. synx_obj->bound_synxs[bound_idx].external_data = data;
  1057. synx_obj->num_bound_synxs++;
  1058. mutex_unlock(&synx_obj->obj_lock);
  1059. rc = bind_ops->register_callback(synx_external_callback,
  1060. data, external_sync.id);
  1061. if (rc) {
  1062. dprintk(SYNX_ERR,
  1063. "[sess :%llu] callback reg failed for %llu\n",
  1064. client->id, external_sync.id);
  1065. mutex_lock(&synx_obj->obj_lock);
  1066. memset(&synx_obj->bound_synxs[bound_idx], 0,
  1067. sizeof(struct synx_external_desc_v2));
  1068. synx_obj->num_bound_synxs--;
  1069. mutex_unlock(&synx_obj->obj_lock);
  1070. synx_util_put_object(synx_obj);
  1071. kfree(data);
  1072. goto fail;
  1073. }
  1074. synx_util_release_handle(synx_data);
  1075. dprintk(SYNX_DBG,
  1076. "[sess :%llu] ext sync %llu bound to handle %u\n",
  1077. client->id, external_sync.id, h_synx);
  1078. synx_put_client(client);
  1079. return SYNX_SUCCESS;
  1080. release:
  1081. mutex_unlock(&synx_obj->obj_lock);
  1082. fail:
  1083. synx_util_release_handle(synx_data);
  1084. synx_put_client(client);
  1085. return rc;
  1086. }
  1087. EXPORT_SYMBOL(synx_bind);
  1088. int synx_get_status(struct synx_session *session,
  1089. u32 h_synx)
  1090. {
  1091. int rc = 0;
  1092. struct synx_client *client;
  1093. struct synx_handle_coredata *synx_data;
  1094. struct synx_coredata *synx_obj;
  1095. client = synx_get_client(session);
  1096. if (IS_ERR_OR_NULL(client))
  1097. return -SYNX_INVALID;
  1098. synx_data = synx_util_acquire_handle(client, h_synx);
  1099. synx_obj = synx_util_obtain_object(synx_data);
  1100. if (IS_ERR_OR_NULL(synx_obj) ||
  1101. IS_ERR_OR_NULL(synx_obj->fence)) {
  1102. dprintk(SYNX_ERR,
  1103. "[sess :%llu] invalid handle access %u\n",
  1104. client->id, h_synx);
  1105. rc = -SYNX_INVALID;
  1106. goto fail;
  1107. }
  1108. if (synx_util_is_global_handle(h_synx)) {
  1109. rc = synx_global_get_status(
  1110. synx_util_global_idx(h_synx));
  1111. if (rc != SYNX_STATE_ACTIVE) {
  1112. dprintk(SYNX_VERB,
  1113. "[sess :%llu] handle %u in status %d\n",
  1114. client->id, h_synx, rc);
  1115. goto fail;
  1116. }
  1117. }
  1118. mutex_lock(&synx_obj->obj_lock);
  1119. rc = synx_util_get_object_status(synx_obj);
  1120. mutex_unlock(&synx_obj->obj_lock);
  1121. dprintk(SYNX_VERB,
  1122. "[sess :%llu] handle %u status %d\n",
  1123. client->id, h_synx, rc);
  1124. fail:
  1125. synx_util_release_handle(synx_data);
  1126. synx_put_client(client);
  1127. return rc;
  1128. }
  1129. EXPORT_SYMBOL(synx_get_status);
  1130. static struct synx_map_entry *synx_handle_conversion(
  1131. struct synx_client *client,
  1132. u32 *h_synx, struct synx_map_entry *old_entry)
  1133. {
  1134. int rc;
  1135. struct synx_map_entry *map_entry = NULL;
  1136. struct synx_coredata *synx_obj;
  1137. if (IS_ERR_OR_NULL(old_entry)) {
  1138. old_entry = synx_util_get_map_entry(*h_synx);
  1139. if (IS_ERR_OR_NULL(old_entry)) {
  1140. rc = PTR_ERR(old_entry);
  1141. dprintk(SYNX_ERR,
  1142. "invalid import handle %u err=%d",
  1143. *h_synx, rc);
  1144. return old_entry;
  1145. }
  1146. }
  1147. synx_obj = old_entry->synx_obj;
  1148. BUG_ON(synx_obj == NULL);
  1149. mutex_lock(&synx_obj->obj_lock);
  1150. synx_util_get_object(synx_obj);
  1151. if (synx_obj->global_idx != 0) {
  1152. *h_synx = synx_encode_handle(
  1153. synx_obj->global_idx, SYNX_CORE_APSS, true);
  1154. map_entry = synx_util_get_map_entry(*h_synx);
  1155. if (IS_ERR_OR_NULL(map_entry)) {
  1156. /* raced with release from last global client */
  1157. map_entry = synx_util_insert_to_map(synx_obj,
  1158. *h_synx, 0);
  1159. if (IS_ERR_OR_NULL(map_entry)) {
  1160. rc = PTR_ERR(map_entry);
  1161. dprintk(SYNX_ERR,
  1162. "addition of %u to map failed=%d",
  1163. *h_synx, rc);
  1164. }
  1165. }
  1166. } else {
  1167. rc = synx_alloc_global_handle(h_synx);
  1168. if (rc == SYNX_SUCCESS) {
  1169. synx_obj->global_idx =
  1170. synx_util_global_idx(*h_synx);
  1171. synx_obj->type |= SYNX_CREATE_GLOBAL_FENCE;
  1172. map_entry = synx_util_insert_to_map(synx_obj,
  1173. *h_synx, 0);
  1174. if (IS_ERR_OR_NULL(map_entry)) {
  1175. rc = PTR_ERR(map_entry);
  1176. synx_global_put_ref(
  1177. synx_util_global_idx(*h_synx));
  1178. dprintk(SYNX_ERR,
  1179. "insertion of %u to map failed=%d",
  1180. *h_synx, rc);
  1181. }
  1182. }
  1183. }
  1184. mutex_unlock(&synx_obj->obj_lock);
  1185. if (IS_ERR_OR_NULL(map_entry))
  1186. synx_util_put_object(synx_obj);
  1187. synx_util_release_map_entry(old_entry);
  1188. return map_entry;
  1189. }
  1190. static int synx_native_import_handle(struct synx_client *client,
  1191. struct synx_import_indv_params *params)
  1192. {
  1193. int rc = SYNX_SUCCESS;
  1194. u32 h_synx, core_id;
  1195. struct synx_map_entry *map_entry, *old_entry;
  1196. struct synx_coredata *synx_obj;
  1197. struct synx_handle_coredata *synx_data = NULL, *curr;
  1198. char name[SYNX_OBJ_NAME_LEN] = {0};
  1199. struct synx_create_params c_params = {0};
  1200. if (IS_ERR_OR_NULL(client) || IS_ERR_OR_NULL(params) ||
  1201. IS_ERR_OR_NULL(params->fence) ||
  1202. IS_ERR_OR_NULL(params->new_h_synx))
  1203. return -SYNX_INVALID;
  1204. h_synx = *((u32 *)params->fence);
  1205. /* check if already mapped to client */
  1206. spin_lock_bh(&client->handle_map_lock);
  1207. hash_for_each_possible(client->handle_map,
  1208. curr, node, h_synx) {
  1209. if (curr->key == h_synx &&
  1210. curr->rel_count != 0 &&
  1211. (synx_util_is_global_handle(h_synx) ||
  1212. params->flags & SYNX_IMPORT_LOCAL_FENCE)) {
  1213. curr->rel_count++;
  1214. kref_get(&curr->refcount);
  1215. synx_data = curr;
  1216. break;
  1217. }
  1218. }
  1219. spin_unlock_bh(&client->handle_map_lock);
  1220. if (synx_data) {
  1221. *params->new_h_synx = h_synx;
  1222. return SYNX_SUCCESS;
  1223. }
  1224. map_entry = synx_util_get_map_entry(h_synx);
  1225. if (IS_ERR_OR_NULL(map_entry)) {
  1226. core_id = (h_synx & SYNX_OBJ_CORE_ID_MASK)
  1227. >> SYNX_HANDLE_INDEX_BITS;
  1228. if (core_id == SYNX_CORE_APSS) {
  1229. dprintk(SYNX_ERR,
  1230. "[sess :%llu] invalid import handle %u\n",
  1231. client->id, h_synx);
  1232. return -SYNX_INVALID;
  1233. } else if (synx_util_is_global_handle(h_synx)) {
  1234. /* import global handle created in another core */
  1235. synx_util_map_import_params_to_create(params, &c_params);
  1236. scnprintf(name, SYNX_OBJ_NAME_LEN, "import-client-%d",
  1237. current->pid);
  1238. c_params.name = name;
  1239. c_params.h_synx = &h_synx;
  1240. rc = synx_native_create_core(client, &c_params);
  1241. if (rc != SYNX_SUCCESS)
  1242. return rc;
  1243. *params->new_h_synx = h_synx;
  1244. return SYNX_SUCCESS;
  1245. }
  1246. dprintk(SYNX_ERR,
  1247. "[sess :%llu] invalid handle %u\n",
  1248. client->id, h_synx);
  1249. return -SYNX_INVALID;
  1250. }
  1251. synx_obj = map_entry->synx_obj;
  1252. BUG_ON(synx_obj == NULL);
  1253. if ((params->flags & SYNX_IMPORT_GLOBAL_FENCE) &&
  1254. !synx_util_is_global_handle(h_synx)) {
  1255. old_entry = map_entry;
  1256. map_entry = synx_handle_conversion(client, &h_synx,
  1257. old_entry);
  1258. }
  1259. if (rc != SYNX_SUCCESS)
  1260. return rc;
  1261. *params->new_h_synx = h_synx;
  1262. rc = synx_util_init_handle(client, map_entry->synx_obj,
  1263. params->new_h_synx, map_entry);
  1264. if (rc != SYNX_SUCCESS) {
  1265. dprintk(SYNX_ERR,
  1266. "[sess :%llu] init of imported handle %u failed=%d\n",
  1267. client->id, h_synx, rc);
  1268. synx_util_release_map_entry(map_entry);
  1269. }
  1270. return rc;
  1271. }
  1272. static int synx_native_import_fence(struct synx_client *client,
  1273. struct synx_import_indv_params *params)
  1274. {
  1275. int rc = SYNX_SUCCESS;
  1276. u32 curr_h_synx;
  1277. u32 global;
  1278. struct synx_create_params c_params = {0};
  1279. char name[SYNX_OBJ_NAME_LEN] = {0};
  1280. struct synx_fence_entry *entry;
  1281. struct synx_map_entry *map_entry = NULL;
  1282. struct synx_handle_coredata *synx_data = NULL, *curr;
  1283. if (IS_ERR_OR_NULL(client) || IS_ERR_OR_NULL(params) ||
  1284. IS_ERR_OR_NULL(params->fence) ||
  1285. IS_ERR_OR_NULL(params->new_h_synx))
  1286. return -SYNX_INVALID;
  1287. global = SYNX_IMPORT_GLOBAL_FENCE & params->flags;
  1288. retry:
  1289. *params->new_h_synx =
  1290. synx_util_get_fence_entry((u64)params->fence, global);
  1291. if (*params->new_h_synx == 0) {
  1292. /* create a new synx obj and add to fence map */
  1293. synx_util_map_import_params_to_create(params, &c_params);
  1294. scnprintf(name, SYNX_OBJ_NAME_LEN, "import-client-%d",
  1295. current->pid);
  1296. c_params.name = name;
  1297. c_params.h_synx = params->new_h_synx;
  1298. c_params.fence = params->fence;
  1299. rc = synx_native_create_core(client, &c_params);
  1300. if (rc != SYNX_SUCCESS)
  1301. return rc;
  1302. curr_h_synx = *params->new_h_synx;
  1303. entry = kzalloc(sizeof(*entry), GFP_KERNEL);
  1304. if (IS_ERR_OR_NULL(entry)) {
  1305. rc = -SYNX_NOMEM;
  1306. curr_h_synx = *c_params.h_synx;
  1307. goto fail;
  1308. }
  1309. do {
  1310. entry->key = (u64)params->fence;
  1311. if (global)
  1312. entry->g_handle = *params->new_h_synx;
  1313. else
  1314. entry->l_handle = *params->new_h_synx;
  1315. rc = synx_util_insert_fence_entry(entry,
  1316. params->new_h_synx, global);
  1317. if (rc == SYNX_SUCCESS) {
  1318. dprintk(SYNX_DBG,
  1319. "mapped fence %pK to new handle %u\n",
  1320. params->fence, *params->new_h_synx);
  1321. break;
  1322. } else if (rc == -SYNX_ALREADY) {
  1323. /*
  1324. * release the new handle allocated
  1325. * and use the available handle
  1326. * already mapped instead.
  1327. */
  1328. map_entry = synx_util_get_map_entry(
  1329. *params->new_h_synx);
  1330. if (IS_ERR_OR_NULL(map_entry)) {
  1331. /* race with fence release, need to retry */
  1332. dprintk(SYNX_DBG,
  1333. "re-attempting handle import\n");
  1334. *params->new_h_synx = curr_h_synx;
  1335. continue;
  1336. }
  1337. rc = synx_util_init_handle(client,
  1338. map_entry->synx_obj,
  1339. params->new_h_synx, map_entry);
  1340. dprintk(SYNX_DBG, "mapped fence %pK to handle %u\n",
  1341. params->fence, *params->new_h_synx);
  1342. goto release;
  1343. } else {
  1344. dprintk(SYNX_ERR,
  1345. "importing fence %pK failed, err=%d\n",
  1346. params->fence, rc);
  1347. goto release;
  1348. }
  1349. } while (true);
  1350. } else {
  1351. /* check if already mapped to client */
  1352. spin_lock_bh(&client->handle_map_lock);
  1353. hash_for_each_possible(client->handle_map,
  1354. curr, node, *params->new_h_synx) {
  1355. if (curr->key == *params->new_h_synx &&
  1356. curr->rel_count != 0) {
  1357. curr->rel_count++;
  1358. kref_get(&curr->refcount);
  1359. synx_data = curr;
  1360. break;
  1361. }
  1362. }
  1363. spin_unlock_bh(&client->handle_map_lock);
  1364. if (synx_data) {
  1365. dprintk(SYNX_DBG, "mapped fence %pK to handle %u\n",
  1366. params->fence, *params->new_h_synx);
  1367. return SYNX_SUCCESS;
  1368. }
  1369. if (global && !synx_util_is_global_handle(
  1370. *params->new_h_synx))
  1371. map_entry = synx_handle_conversion(client,
  1372. params->new_h_synx, NULL);
  1373. else
  1374. map_entry = synx_util_get_map_entry(
  1375. *params->new_h_synx);
  1376. if (IS_ERR_OR_NULL(map_entry)) {
  1377. /* race with fence release, need to retry */
  1378. dprintk(SYNX_DBG, "re-attempting handle import\n");
  1379. goto retry;
  1380. }
  1381. rc = synx_util_init_handle(client, map_entry->synx_obj,
  1382. params->new_h_synx, map_entry);
  1383. dprintk(SYNX_DBG, "mapped fence %pK to existing handle %u\n",
  1384. params->fence, *params->new_h_synx);
  1385. }
  1386. return rc;
  1387. release:
  1388. kfree(entry);
  1389. fail:
  1390. synx_native_release_core(client, curr_h_synx);
  1391. return rc;
  1392. }
  1393. static int synx_native_import_indv(struct synx_client *client,
  1394. struct synx_import_indv_params *params)
  1395. {
  1396. int rc = -SYNX_INVALID;
  1397. if (IS_ERR_OR_NULL(params) ||
  1398. IS_ERR_OR_NULL(params->new_h_synx) ||
  1399. IS_ERR_OR_NULL(params->fence)) {
  1400. dprintk(SYNX_ERR, "invalid import arguments\n");
  1401. return -SYNX_INVALID;
  1402. }
  1403. if (likely(params->flags & SYNX_IMPORT_DMA_FENCE))
  1404. rc = synx_native_import_fence(client, params);
  1405. else if (params->flags & SYNX_IMPORT_SYNX_FENCE)
  1406. rc = synx_native_import_handle(client, params);
  1407. dprintk(SYNX_DBG,
  1408. "[sess :%llu] import of fence %pK %s, handle %u\n",
  1409. client->id, params->fence,
  1410. rc ? "failed" : "successful",
  1411. rc ? 0 : *params->new_h_synx);
  1412. return rc;
  1413. }
  1414. static int synx_native_import_arr(struct synx_client *client,
  1415. struct synx_import_arr_params *params)
  1416. {
  1417. u32 i;
  1418. int rc = SYNX_SUCCESS;
  1419. if (IS_ERR_OR_NULL(params) || params->num_fences == 0) {
  1420. dprintk(SYNX_ERR, "invalid import arr arguments\n");
  1421. return -SYNX_INVALID;
  1422. }
  1423. for (i = 0; i < params->num_fences; i++) {
  1424. rc = synx_native_import_indv(client, &params->list[i]);
  1425. if (rc != SYNX_SUCCESS) {
  1426. dprintk(SYNX_ERR,
  1427. "importing fence[%u] %pK failed=%d\n",
  1428. i, params->list[i].fence, rc);
  1429. break;
  1430. }
  1431. }
  1432. if (rc != SYNX_SUCCESS)
  1433. while (i--) {
  1434. /* release the imported handles and cleanup */
  1435. if (synx_native_release_core(client,
  1436. *params->list[i].new_h_synx) != SYNX_SUCCESS)
  1437. dprintk(SYNX_ERR,
  1438. "error cleaning up imported handle[%u] %u\n",
  1439. i, *params->list[i].new_h_synx);
  1440. }
  1441. return rc;
  1442. }
  1443. int synx_import(struct synx_session *session,
  1444. struct synx_import_params *params)
  1445. {
  1446. int rc = 0;
  1447. struct synx_client *client;
  1448. if (IS_ERR_OR_NULL(params)) {
  1449. dprintk(SYNX_ERR, "invalid import arguments\n");
  1450. return -SYNX_INVALID;
  1451. }
  1452. client = synx_get_client(session);
  1453. if (IS_ERR_OR_NULL(client))
  1454. return -SYNX_INVALID;
  1455. /* import fence based on its type */
  1456. if (params->type == SYNX_IMPORT_ARR_PARAMS)
  1457. rc = synx_native_import_arr(client, &params->arr);
  1458. else
  1459. rc = synx_native_import_indv(client, &params->indv);
  1460. synx_put_client(client);
  1461. return rc;
  1462. }
  1463. EXPORT_SYMBOL(synx_import);
  1464. static int synx_handle_create(struct synx_private_ioctl_arg *k_ioctl,
  1465. struct synx_session *session)
  1466. {
  1467. int result;
  1468. int csl_fence;
  1469. struct synx_create_v2 create_info;
  1470. struct synx_create_params params = {0};
  1471. if (k_ioctl->size != sizeof(create_info))
  1472. return -SYNX_INVALID;
  1473. if (copy_from_user(&create_info,
  1474. u64_to_user_ptr(k_ioctl->ioctl_ptr),
  1475. k_ioctl->size))
  1476. return -EFAULT;
  1477. params.h_synx = &create_info.synx_obj;
  1478. params.name = create_info.name;
  1479. params.flags = create_info.flags;
  1480. if (create_info.flags & SYNX_CREATE_CSL_FENCE) {
  1481. csl_fence = create_info.desc.id[0];
  1482. params.fence = &csl_fence;
  1483. }
  1484. result = synx_create(session, &params);
  1485. if (!result)
  1486. if (copy_to_user(u64_to_user_ptr(k_ioctl->ioctl_ptr),
  1487. &create_info,
  1488. k_ioctl->size))
  1489. return -EFAULT;
  1490. return result;
  1491. }
  1492. static int synx_handle_getstatus(struct synx_private_ioctl_arg *k_ioctl,
  1493. struct synx_session *session)
  1494. {
  1495. struct synx_signal_v2 signal_info;
  1496. if (k_ioctl->size != sizeof(signal_info))
  1497. return -SYNX_INVALID;
  1498. if (copy_from_user(&signal_info,
  1499. u64_to_user_ptr(k_ioctl->ioctl_ptr),
  1500. k_ioctl->size))
  1501. return -EFAULT;
  1502. signal_info.synx_state =
  1503. synx_get_status(session, signal_info.synx_obj);
  1504. if (copy_to_user(u64_to_user_ptr(k_ioctl->ioctl_ptr),
  1505. &signal_info,
  1506. k_ioctl->size))
  1507. return -EFAULT;
  1508. return SYNX_SUCCESS;
  1509. }
  1510. static int synx_handle_import(struct synx_private_ioctl_arg *k_ioctl,
  1511. struct synx_session *session)
  1512. {
  1513. struct synx_import_info import_info;
  1514. struct synx_import_params params = {0};
  1515. if (k_ioctl->size != sizeof(import_info))
  1516. return -SYNX_INVALID;
  1517. if (copy_from_user(&import_info,
  1518. u64_to_user_ptr(k_ioctl->ioctl_ptr),
  1519. k_ioctl->size))
  1520. return -EFAULT;
  1521. if (import_info.flags & SYNX_IMPORT_SYNX_FENCE)
  1522. params.indv.fence = &import_info.synx_obj;
  1523. else if (import_info.flags & SYNX_IMPORT_DMA_FENCE)
  1524. params.indv.fence =
  1525. sync_file_get_fence(import_info.desc.id[0]);
  1526. params.type = SYNX_IMPORT_INDV_PARAMS;
  1527. params.indv.flags = import_info.flags;
  1528. params.indv.new_h_synx = &import_info.new_synx_obj;
  1529. if (synx_import(session, &params))
  1530. return -SYNX_INVALID;
  1531. if (import_info.flags & SYNX_IMPORT_DMA_FENCE)
  1532. dma_fence_put(params.indv.fence);
  1533. if (copy_to_user(u64_to_user_ptr(k_ioctl->ioctl_ptr),
  1534. &import_info,
  1535. k_ioctl->size))
  1536. return -EFAULT;
  1537. return SYNX_SUCCESS;
  1538. }
  1539. static int synx_handle_import_arr(
  1540. struct synx_private_ioctl_arg *k_ioctl,
  1541. struct synx_session *session)
  1542. {
  1543. int rc = -SYNX_INVALID;
  1544. u32 idx = 0;
  1545. struct synx_client *client;
  1546. struct synx_import_arr_info arr_info;
  1547. struct synx_import_info *arr;
  1548. struct synx_import_indv_params params = {0};
  1549. if (k_ioctl->size != sizeof(arr_info))
  1550. return -SYNX_INVALID;
  1551. if (copy_from_user(&arr_info,
  1552. u64_to_user_ptr(k_ioctl->ioctl_ptr),
  1553. k_ioctl->size))
  1554. return -EFAULT;
  1555. arr = kcalloc(arr_info.num_objs,
  1556. sizeof(*arr), GFP_KERNEL);
  1557. if (IS_ERR_OR_NULL(arr))
  1558. return -ENOMEM;
  1559. client = synx_get_client(session);
  1560. if (IS_ERR_OR_NULL(client)) {
  1561. rc = PTR_ERR(client);
  1562. goto clean;
  1563. }
  1564. if (copy_from_user(arr,
  1565. u64_to_user_ptr(arr_info.list),
  1566. sizeof(*arr) * arr_info.num_objs)) {
  1567. rc = -EFAULT;
  1568. goto fail;
  1569. }
  1570. while (idx < arr_info.num_objs) {
  1571. params.new_h_synx = &arr[idx].new_synx_obj;
  1572. params.flags = arr[idx].flags;
  1573. if (arr[idx].flags & SYNX_IMPORT_SYNX_FENCE)
  1574. params.fence = &arr[idx].synx_obj;
  1575. if (arr[idx].flags & SYNX_IMPORT_DMA_FENCE)
  1576. params.fence =
  1577. sync_file_get_fence(arr[idx].desc.id[0]);
  1578. rc = synx_native_import_indv(client, &params);
  1579. if (rc != SYNX_SUCCESS)
  1580. break;
  1581. idx++;
  1582. }
  1583. /* release allocated handles in case of failure */
  1584. if (rc != SYNX_SUCCESS) {
  1585. while (idx > 0)
  1586. synx_native_release_core(client,
  1587. arr[--idx].new_synx_obj);
  1588. } else {
  1589. if (copy_to_user(u64_to_user_ptr(arr_info.list),
  1590. arr,
  1591. sizeof(*arr) * arr_info.num_objs)) {
  1592. rc = -EFAULT;
  1593. goto fail;
  1594. }
  1595. }
  1596. fail:
  1597. synx_put_client(client);
  1598. clean:
  1599. kfree(arr);
  1600. return rc;
  1601. }
  1602. static int synx_handle_export(struct synx_private_ioctl_arg *k_ioctl,
  1603. struct synx_session *session)
  1604. {
  1605. return -SYNX_INVALID;
  1606. }
  1607. static int synx_handle_signal(struct synx_private_ioctl_arg *k_ioctl,
  1608. struct synx_session *session)
  1609. {
  1610. struct synx_signal_v2 signal_info;
  1611. if (k_ioctl->size != sizeof(signal_info))
  1612. return -SYNX_INVALID;
  1613. if (copy_from_user(&signal_info,
  1614. u64_to_user_ptr(k_ioctl->ioctl_ptr),
  1615. k_ioctl->size))
  1616. return -EFAULT;
  1617. return synx_signal(session, signal_info.synx_obj,
  1618. signal_info.synx_state);
  1619. }
  1620. static int synx_handle_merge(struct synx_private_ioctl_arg *k_ioctl,
  1621. struct synx_session *session)
  1622. {
  1623. u32 *h_synxs;
  1624. int result;
  1625. struct synx_merge_v2 merge_info;
  1626. struct synx_merge_params params = {0};
  1627. if (k_ioctl->size != sizeof(merge_info))
  1628. return -SYNX_INVALID;
  1629. if (copy_from_user(&merge_info,
  1630. u64_to_user_ptr(k_ioctl->ioctl_ptr),
  1631. k_ioctl->size))
  1632. return -EFAULT;
  1633. if (merge_info.num_objs >= SYNX_MAX_OBJS)
  1634. return -SYNX_INVALID;
  1635. h_synxs = kcalloc(merge_info.num_objs,
  1636. sizeof(*h_synxs), GFP_KERNEL);
  1637. if (IS_ERR_OR_NULL(h_synxs))
  1638. return -ENOMEM;
  1639. if (copy_from_user(h_synxs,
  1640. u64_to_user_ptr(merge_info.synx_objs),
  1641. sizeof(u32) * merge_info.num_objs)) {
  1642. kfree(h_synxs);
  1643. return -EFAULT;
  1644. }
  1645. params.num_objs = merge_info.num_objs;
  1646. params.h_synxs = h_synxs;
  1647. params.flags = merge_info.flags;
  1648. params.h_merged_obj = &merge_info.merged;
  1649. result = synx_merge(session, &params);
  1650. if (!result)
  1651. if (copy_to_user(u64_to_user_ptr(k_ioctl->ioctl_ptr),
  1652. &merge_info,
  1653. k_ioctl->size)) {
  1654. kfree(h_synxs);
  1655. return -EFAULT;
  1656. }
  1657. kfree(h_synxs);
  1658. return result;
  1659. }
  1660. static int synx_handle_wait(struct synx_private_ioctl_arg *k_ioctl,
  1661. struct synx_session *session)
  1662. {
  1663. struct synx_wait_v2 wait_info;
  1664. if (k_ioctl->size != sizeof(wait_info))
  1665. return -SYNX_INVALID;
  1666. if (copy_from_user(&wait_info,
  1667. u64_to_user_ptr(k_ioctl->ioctl_ptr),
  1668. k_ioctl->size))
  1669. return -EFAULT;
  1670. k_ioctl->result = synx_wait(session,
  1671. wait_info.synx_obj, wait_info.timeout_ms);
  1672. return SYNX_SUCCESS;
  1673. }
  1674. static int synx_handle_async_wait(
  1675. struct synx_private_ioctl_arg *k_ioctl,
  1676. struct synx_session *session)
  1677. {
  1678. int rc = 0;
  1679. struct synx_userpayload_info_v2 user_data;
  1680. struct synx_callback_params params = {0};
  1681. if (k_ioctl->size != sizeof(user_data))
  1682. return -SYNX_INVALID;
  1683. if (copy_from_user(&user_data,
  1684. u64_to_user_ptr(k_ioctl->ioctl_ptr),
  1685. k_ioctl->size))
  1686. return -EFAULT;
  1687. params.h_synx = user_data.synx_obj;
  1688. params.cb_func = synx_util_default_user_callback;
  1689. params.userdata = (void *)user_data.payload[0];
  1690. rc = synx_async_wait(session, &params);
  1691. if (rc)
  1692. dprintk(SYNX_ERR,
  1693. "user cb registration failed for handle %d\n",
  1694. user_data.synx_obj);
  1695. return rc;
  1696. }
  1697. static int synx_handle_cancel_async_wait(
  1698. struct synx_private_ioctl_arg *k_ioctl,
  1699. struct synx_session *session)
  1700. {
  1701. int rc = 0;
  1702. struct synx_userpayload_info_v2 user_data;
  1703. struct synx_callback_params params = {0};
  1704. if (k_ioctl->size != sizeof(user_data))
  1705. return -SYNX_INVALID;
  1706. if (copy_from_user(&user_data,
  1707. u64_to_user_ptr(k_ioctl->ioctl_ptr),
  1708. k_ioctl->size))
  1709. return -EFAULT;
  1710. params.h_synx = user_data.synx_obj;
  1711. params.cb_func = synx_util_default_user_callback;
  1712. params.userdata = (void *)user_data.payload[0];
  1713. rc = synx_cancel_async_wait(session, &params);
  1714. if (rc)
  1715. dprintk(SYNX_ERR,
  1716. "user cb deregistration failed for handle %d\n",
  1717. user_data.synx_obj);
  1718. return rc;
  1719. }
  1720. static int synx_handle_bind(struct synx_private_ioctl_arg *k_ioctl,
  1721. struct synx_session *session)
  1722. {
  1723. struct synx_bind_v2 synx_bind_info;
  1724. if (k_ioctl->size != sizeof(synx_bind_info))
  1725. return -SYNX_INVALID;
  1726. if (copy_from_user(&synx_bind_info,
  1727. u64_to_user_ptr(k_ioctl->ioctl_ptr),
  1728. k_ioctl->size))
  1729. return -EFAULT;
  1730. k_ioctl->result = synx_bind(session,
  1731. synx_bind_info.synx_obj,
  1732. synx_bind_info.ext_sync_desc);
  1733. return k_ioctl->result;
  1734. }
  1735. static int synx_handle_release(struct synx_private_ioctl_arg *k_ioctl,
  1736. struct synx_session *session)
  1737. {
  1738. struct synx_info release_info;
  1739. if (k_ioctl->size != sizeof(release_info))
  1740. return -SYNX_INVALID;
  1741. if (copy_from_user(&release_info,
  1742. u64_to_user_ptr(k_ioctl->ioctl_ptr),
  1743. k_ioctl->size))
  1744. return -EFAULT;
  1745. return synx_release(session, release_info.synx_obj);
  1746. }
  1747. static int synx_handle_get_fence(struct synx_private_ioctl_arg *k_ioctl,
  1748. struct synx_session *session)
  1749. {
  1750. struct synx_fence_fd fence_fd;
  1751. struct dma_fence *fence;
  1752. if (k_ioctl->size != sizeof(fence_fd))
  1753. return -SYNX_INVALID;
  1754. if (copy_from_user(&fence_fd,
  1755. u64_to_user_ptr(k_ioctl->ioctl_ptr),
  1756. k_ioctl->size))
  1757. return -EFAULT;
  1758. fence = synx_get_fence(session, fence_fd.synx_obj);
  1759. fence_fd.fd = synx_create_sync_fd(fence);
  1760. /*
  1761. * release additional reference taken in synx_get_fence.
  1762. * additional reference ensures the fence is valid and
  1763. * does not race with handle/fence release.
  1764. */
  1765. dma_fence_put(fence);
  1766. if (copy_to_user(u64_to_user_ptr(k_ioctl->ioctl_ptr),
  1767. &fence_fd, k_ioctl->size))
  1768. return -EFAULT;
  1769. return SYNX_SUCCESS;
  1770. }
  1771. static long synx_ioctl(struct file *filep,
  1772. unsigned int cmd,
  1773. unsigned long arg)
  1774. {
  1775. s32 rc = 0;
  1776. struct synx_private_ioctl_arg k_ioctl;
  1777. struct synx_session *session = filep->private_data;
  1778. if (cmd != SYNX_PRIVATE_IOCTL_CMD) {
  1779. dprintk(SYNX_ERR, "invalid ioctl cmd\n");
  1780. return -ENOIOCTLCMD;
  1781. }
  1782. if (copy_from_user(&k_ioctl,
  1783. (struct synx_private_ioctl_arg *)arg,
  1784. sizeof(k_ioctl))) {
  1785. dprintk(SYNX_ERR, "invalid ioctl args\n");
  1786. return -EFAULT;
  1787. }
  1788. if (!k_ioctl.ioctl_ptr)
  1789. return -SYNX_INVALID;
  1790. dprintk(SYNX_VERB, "[sess :%llu] Enter cmd %u from pid %d\n",
  1791. ((struct synx_client *)session)->id,
  1792. k_ioctl.id, current->pid);
  1793. switch (k_ioctl.id) {
  1794. case SYNX_CREATE:
  1795. rc = synx_handle_create(&k_ioctl, session);
  1796. break;
  1797. case SYNX_RELEASE:
  1798. rc = synx_handle_release(&k_ioctl, session);
  1799. break;
  1800. case SYNX_REGISTER_PAYLOAD:
  1801. rc = synx_handle_async_wait(&k_ioctl,
  1802. session);
  1803. break;
  1804. case SYNX_DEREGISTER_PAYLOAD:
  1805. rc = synx_handle_cancel_async_wait(&k_ioctl,
  1806. session);
  1807. break;
  1808. case SYNX_SIGNAL:
  1809. rc = synx_handle_signal(&k_ioctl, session);
  1810. break;
  1811. case SYNX_MERGE:
  1812. rc = synx_handle_merge(&k_ioctl, session);
  1813. break;
  1814. case SYNX_WAIT:
  1815. rc = synx_handle_wait(&k_ioctl, session);
  1816. if (copy_to_user((void *)arg,
  1817. &k_ioctl,
  1818. sizeof(k_ioctl))) {
  1819. dprintk(SYNX_ERR, "invalid ioctl args\n");
  1820. rc = -EFAULT;
  1821. }
  1822. break;
  1823. case SYNX_BIND:
  1824. rc = synx_handle_bind(&k_ioctl, session);
  1825. break;
  1826. case SYNX_GETSTATUS:
  1827. rc = synx_handle_getstatus(&k_ioctl, session);
  1828. break;
  1829. case SYNX_IMPORT:
  1830. rc = synx_handle_import(&k_ioctl, session);
  1831. break;
  1832. case SYNX_IMPORT_ARR:
  1833. rc = synx_handle_import_arr(&k_ioctl, session);
  1834. break;
  1835. case SYNX_EXPORT:
  1836. rc = synx_handle_export(&k_ioctl, session);
  1837. break;
  1838. case SYNX_GETFENCE_FD:
  1839. rc = synx_handle_get_fence(&k_ioctl, session);
  1840. break;
  1841. default:
  1842. rc = -SYNX_INVALID;
  1843. }
  1844. dprintk(SYNX_VERB, "[sess :%llu] exit with status %d\n",
  1845. ((struct synx_client *)session)->id, rc);
  1846. return rc;
  1847. }
  1848. static ssize_t synx_read(struct file *filep,
  1849. char __user *buf, size_t size, loff_t *f_pos)
  1850. {
  1851. ssize_t rc = 0;
  1852. struct synx_client *client = NULL;
  1853. struct synx_client_cb *cb;
  1854. struct synx_session *session = filep->private_data;
  1855. struct synx_userpayload_info_v2 data;
  1856. if (size != sizeof(struct synx_userpayload_info_v2)) {
  1857. dprintk(SYNX_ERR, "invalid read size\n");
  1858. return -SYNX_INVALID;
  1859. }
  1860. client = synx_get_client(session);
  1861. if (IS_ERR_OR_NULL(client))
  1862. return -SYNX_INVALID;
  1863. mutex_lock(&client->event_q_lock);
  1864. cb = list_first_entry_or_null(&client->event_q,
  1865. struct synx_client_cb, node);
  1866. if (IS_ERR_OR_NULL(cb)) {
  1867. mutex_unlock(&client->event_q_lock);
  1868. rc = 0;
  1869. goto fail;
  1870. }
  1871. if (cb->idx == 0 || cb->idx >= SYNX_MAX_OBJS) {
  1872. dprintk(SYNX_ERR, "invalid index\n");
  1873. mutex_unlock(&client->event_q_lock);
  1874. rc = -SYNX_INVALID;
  1875. goto fail;
  1876. }
  1877. list_del_init(&cb->node);
  1878. mutex_unlock(&client->event_q_lock);
  1879. rc = size;
  1880. data.synx_obj = cb->kernel_cb.h_synx;
  1881. data.reserved = cb->kernel_cb.status;
  1882. data.payload[0] = (u64)cb->kernel_cb.data;
  1883. if (copy_to_user(buf,
  1884. &data,
  1885. sizeof(struct synx_userpayload_info_v2))) {
  1886. dprintk(SYNX_ERR, "couldn't copy user callback data\n");
  1887. rc = -EFAULT;
  1888. }
  1889. if (synx_util_clear_cb_entry(client, cb))
  1890. dprintk(SYNX_ERR,
  1891. "[sess :%llu] error clearing cb for handle %u\n",
  1892. client->id, data.synx_obj);
  1893. fail:
  1894. synx_put_client(client);
  1895. return rc;
  1896. }
  1897. static unsigned int synx_poll(struct file *filep,
  1898. struct poll_table_struct *poll_table)
  1899. {
  1900. int rc = 0;
  1901. struct synx_client *client;
  1902. struct synx_session *session = filep->private_data;
  1903. client = synx_get_client(session);
  1904. if (IS_ERR_OR_NULL(client)) {
  1905. dprintk(SYNX_ERR, "invalid session in poll\n");
  1906. return SYNX_SUCCESS;
  1907. }
  1908. poll_wait(filep, &client->event_wq, poll_table);
  1909. mutex_lock(&client->event_q_lock);
  1910. if (!list_empty(&client->event_q))
  1911. rc = POLLPRI;
  1912. mutex_unlock(&client->event_q_lock);
  1913. synx_put_client(client);
  1914. return rc;
  1915. }
  1916. struct synx_session *synx_initialize(
  1917. struct synx_initialization_params *params)
  1918. {
  1919. struct synx_client *client;
  1920. if (IS_ERR_OR_NULL(params))
  1921. return ERR_PTR(-SYNX_INVALID);
  1922. client = vzalloc(sizeof(*client));
  1923. if (IS_ERR_OR_NULL(client))
  1924. return ERR_PTR(-SYNX_NOMEM);
  1925. if (params->name)
  1926. strlcpy(client->name, params->name, sizeof(client->name));
  1927. client->active = true;
  1928. client->dma_context = dma_fence_context_alloc(1);
  1929. client->id = atomic64_inc_return(&synx_counter);
  1930. kref_init(&client->refcount);
  1931. spin_lock_init(&client->handle_map_lock);
  1932. mutex_init(&client->event_q_lock);
  1933. INIT_LIST_HEAD(&client->event_q);
  1934. init_waitqueue_head(&client->event_wq);
  1935. /* zero idx not allowed */
  1936. set_bit(0, client->cb_bitmap);
  1937. spin_lock_bh(&synx_dev->native->metadata_map_lock);
  1938. hash_add(synx_dev->native->client_metadata_map,
  1939. &client->node, (u64)client);
  1940. spin_unlock_bh(&synx_dev->native->metadata_map_lock);
  1941. dprintk(SYNX_INFO, "[sess :%llu] session created %s\n",
  1942. client->id, params->name);
  1943. return (struct synx_session *)client;
  1944. }
  1945. EXPORT_SYMBOL(synx_initialize);
  1946. int synx_uninitialize(struct synx_session *session)
  1947. {
  1948. struct synx_client *client = NULL, *curr;
  1949. spin_lock_bh(&synx_dev->native->metadata_map_lock);
  1950. hash_for_each_possible(synx_dev->native->client_metadata_map,
  1951. curr, node, (u64)session) {
  1952. if (curr == (struct synx_client *)session) {
  1953. if (curr->active) {
  1954. curr->active = false;
  1955. client = curr;
  1956. }
  1957. break;
  1958. }
  1959. }
  1960. spin_unlock_bh(&synx_dev->native->metadata_map_lock);
  1961. /* release the reference obtained at synx init */
  1962. synx_put_client(client);
  1963. return SYNX_SUCCESS;
  1964. }
  1965. EXPORT_SYMBOL(synx_uninitialize);
  1966. static int synx_open(struct inode *inode, struct file *filep)
  1967. {
  1968. int rc = 0;
  1969. char name[SYNX_OBJ_NAME_LEN];
  1970. struct synx_initialization_params params = {0};
  1971. dprintk(SYNX_VERB, "Enter pid: %d\n", current->pid);
  1972. scnprintf(name, SYNX_OBJ_NAME_LEN, "umd-client-%d", current->pid);
  1973. params.name = name;
  1974. params.id = SYNX_CLIENT_NATIVE;
  1975. filep->private_data = synx_initialize(&params);
  1976. if (IS_ERR_OR_NULL(filep->private_data)) {
  1977. dprintk(SYNX_ERR, "session allocation failed for pid: %d\n",
  1978. current->pid);
  1979. rc = PTR_ERR(filep->private_data);
  1980. } else {
  1981. dprintk(SYNX_VERB, "allocated new session for pid: %d\n",
  1982. current->pid);
  1983. }
  1984. return rc;
  1985. }
  1986. static int synx_close(struct inode *inode, struct file *filep)
  1987. {
  1988. struct synx_session *session = filep->private_data;
  1989. return synx_uninitialize(session);
  1990. }
  1991. static const struct file_operations synx_fops = {
  1992. .owner = THIS_MODULE,
  1993. .open = synx_open,
  1994. .read = synx_read,
  1995. .release = synx_close,
  1996. .poll = synx_poll,
  1997. .unlocked_ioctl = synx_ioctl,
  1998. #ifdef CONFIG_COMPAT
  1999. .compat_ioctl = synx_ioctl,
  2000. #endif
  2001. };
  2002. int synx_register_ops(
  2003. const struct synx_register_params *params)
  2004. {
  2005. s32 rc = 0;
  2006. struct synx_registered_ops *client_ops;
  2007. if (!synx_dev || !params || !params->name ||
  2008. !synx_util_is_valid_bind_type(params->type) ||
  2009. !params->ops.register_callback ||
  2010. !params->ops.deregister_callback ||
  2011. !params->ops.signal) {
  2012. dprintk(SYNX_ERR, "invalid register params\n");
  2013. return -SYNX_INVALID;
  2014. }
  2015. mutex_lock(&synx_dev->vtbl_lock);
  2016. client_ops = &synx_dev->bind_vtbl[params->type];
  2017. if (!client_ops->valid) {
  2018. client_ops->valid = true;
  2019. memcpy(&client_ops->ops, &params->ops,
  2020. sizeof(client_ops->ops));
  2021. strlcpy(client_ops->name, params->name,
  2022. sizeof(client_ops->name));
  2023. client_ops->type = params->type;
  2024. dprintk(SYNX_INFO,
  2025. "registered bind ops type %u for %s\n",
  2026. params->type, params->name);
  2027. } else {
  2028. dprintk(SYNX_WARN,
  2029. "client already registered for type %u by %s\n",
  2030. client_ops->type, client_ops->name);
  2031. rc = -SYNX_ALREADY;
  2032. }
  2033. mutex_unlock(&synx_dev->vtbl_lock);
  2034. return rc;
  2035. }
  2036. EXPORT_SYMBOL(synx_register_ops);
  2037. int synx_deregister_ops(
  2038. const struct synx_register_params *params)
  2039. {
  2040. struct synx_registered_ops *client_ops;
  2041. if (IS_ERR_OR_NULL(params) || params->name ||
  2042. !synx_util_is_valid_bind_type(params->type)) {
  2043. dprintk(SYNX_ERR, "invalid params\n");
  2044. return -SYNX_INVALID;
  2045. }
  2046. mutex_lock(&synx_dev->vtbl_lock);
  2047. client_ops = &synx_dev->bind_vtbl[params->type];
  2048. memset(client_ops, 0, sizeof(*client_ops));
  2049. dprintk(SYNX_INFO, "deregistered bind ops for %s\n",
  2050. params->name);
  2051. mutex_unlock(&synx_dev->vtbl_lock);
  2052. return SYNX_SUCCESS;
  2053. }
  2054. EXPORT_SYMBOL(synx_deregister_ops);
  2055. void synx_ipc_handler(struct work_struct *cb_dispatch)
  2056. {
  2057. struct synx_signal_cb *signal_cb =
  2058. container_of(cb_dispatch, struct synx_signal_cb, cb_dispatch);
  2059. struct synx_map_entry *map_entry;
  2060. map_entry = synx_util_get_map_entry(signal_cb->handle);
  2061. if (IS_ERR_OR_NULL(map_entry)) {
  2062. dprintk(SYNX_WARN,
  2063. "no clients to notify for %u\n",
  2064. signal_cb->handle);
  2065. dprintk(SYNX_MEM, "signal cb destroyed %pK\n", signal_cb);
  2066. kfree(signal_cb);
  2067. return;
  2068. }
  2069. /* get reference on synx coredata for signal cb */
  2070. synx_util_get_object(map_entry->synx_obj);
  2071. signal_cb->synx_obj = map_entry->synx_obj;
  2072. synx_util_release_map_entry(map_entry);
  2073. synx_signal_handler(&signal_cb->cb_dispatch);
  2074. }
  2075. int synx_ipc_callback(u32 client_id,
  2076. s64 data, void *priv)
  2077. {
  2078. struct synx_signal_cb *signal_cb;
  2079. u32 status = (u32)data;
  2080. u32 handle = (u32)(data >> 32);
  2081. signal_cb = kzalloc(sizeof(*signal_cb), GFP_ATOMIC);
  2082. if (IS_ERR_OR_NULL(signal_cb))
  2083. return -SYNX_NOMEM;
  2084. dprintk(SYNX_DBG,
  2085. "signal notification for %u received with status %u\n",
  2086. handle, status);
  2087. signal_cb->status = status;
  2088. signal_cb->handle = handle;
  2089. signal_cb->flag = SYNX_SIGNAL_FROM_IPC;
  2090. INIT_WORK(&signal_cb->cb_dispatch, synx_ipc_handler);
  2091. queue_work(synx_dev->wq_cb, &signal_cb->cb_dispatch);
  2092. return SYNX_SUCCESS;
  2093. }
  2094. EXPORT_SYMBOL(synx_ipc_callback);
  2095. int synx_recover(enum synx_client_id id)
  2096. {
  2097. u32 core_id;
  2098. core_id = synx_util_map_client_id_to_core(id);
  2099. if (core_id >= SYNX_CORE_MAX) {
  2100. dprintk(SYNX_ERR, "invalid client id %u\n", id);
  2101. return -SYNX_INVALID;
  2102. }
  2103. switch (core_id) {
  2104. case SYNX_CORE_EVA:
  2105. case SYNX_CORE_IRIS:
  2106. case SYNX_CORE_ICP:
  2107. break;
  2108. default:
  2109. dprintk(SYNX_ERR, "recovery not supported on %u\n", id);
  2110. return -SYNX_NOSUPPORT;
  2111. }
  2112. return synx_global_recover(core_id);
  2113. }
  2114. EXPORT_SYMBOL(synx_recover);
  2115. static int synx_local_mem_init(void)
  2116. {
  2117. if (!synx_dev->native)
  2118. return -SYNX_INVALID;
  2119. hash_init(synx_dev->native->client_metadata_map);
  2120. hash_init(synx_dev->native->fence_map);
  2121. hash_init(synx_dev->native->global_map);
  2122. hash_init(synx_dev->native->local_map);
  2123. hash_init(synx_dev->native->csl_fence_map);
  2124. spin_lock_init(&synx_dev->native->metadata_map_lock);
  2125. spin_lock_init(&synx_dev->native->fence_map_lock);
  2126. spin_lock_init(&synx_dev->native->global_map_lock);
  2127. spin_lock_init(&synx_dev->native->local_map_lock);
  2128. spin_lock_init(&synx_dev->native->csl_map_lock);
  2129. /* zero idx not allowed */
  2130. set_bit(0, synx_dev->native->bitmap);
  2131. return 0;
  2132. }
  2133. static int synx_cdsp_restart_notifier(struct notifier_block *nb,
  2134. unsigned long code, void *data)
  2135. {
  2136. struct synx_cdsp_ssr *cdsp_ssr = &synx_dev->cdsp_ssr;
  2137. if (&cdsp_ssr->nb != nb) {
  2138. dprintk(SYNX_ERR, "Invalid SSR Notifier block\n");
  2139. return NOTIFY_BAD;
  2140. }
  2141. switch (code) {
  2142. case QCOM_SSR_BEFORE_SHUTDOWN:
  2143. break;
  2144. case QCOM_SSR_AFTER_SHUTDOWN:
  2145. if (cdsp_ssr->ssrcnt != 0) {
  2146. dprintk(SYNX_INFO, "Cleaning up global memory\n");
  2147. synx_global_recover(SYNX_CORE_NSP);
  2148. }
  2149. break;
  2150. case QCOM_SSR_BEFORE_POWERUP:
  2151. break;
  2152. case QCOM_SSR_AFTER_POWERUP:
  2153. dprintk(SYNX_DBG, "CDSP is up");
  2154. if (cdsp_ssr->ssrcnt == 0)
  2155. cdsp_ssr->ssrcnt++;
  2156. break;
  2157. default:
  2158. dprintk(SYNX_ERR, "Unknown status code for CDSP SSR\n");
  2159. break;
  2160. }
  2161. return NOTIFY_DONE;
  2162. }
  2163. static int __init synx_init(void)
  2164. {
  2165. int rc;
  2166. dprintk(SYNX_INFO, "device initialization start\n");
  2167. synx_dev = kzalloc(sizeof(*synx_dev), GFP_KERNEL);
  2168. if (IS_ERR_OR_NULL(synx_dev))
  2169. return -SYNX_NOMEM;
  2170. rc = alloc_chrdev_region(&synx_dev->dev, 0, 1, SYNX_DEVICE_NAME);
  2171. if (rc < 0) {
  2172. dprintk(SYNX_ERR, "region allocation failed\n");
  2173. goto alloc_fail;
  2174. }
  2175. cdev_init(&synx_dev->cdev, &synx_fops);
  2176. synx_dev->cdev.owner = THIS_MODULE;
  2177. rc = cdev_add(&synx_dev->cdev, synx_dev->dev, 1);
  2178. if (rc < 0) {
  2179. dprintk(SYNX_ERR, "device registation failed\n");
  2180. goto reg_fail;
  2181. }
  2182. synx_dev->class = class_create(THIS_MODULE, SYNX_DEVICE_NAME);
  2183. device_create(synx_dev->class, NULL, synx_dev->dev,
  2184. NULL, SYNX_DEVICE_NAME);
  2185. synx_dev->wq_cb = alloc_workqueue(SYNX_WQ_CB_NAME,
  2186. WQ_HIGHPRI | WQ_UNBOUND, SYNX_WQ_CB_THREADS);
  2187. synx_dev->wq_cleanup = alloc_workqueue(SYNX_WQ_CLEANUP_NAME,
  2188. WQ_HIGHPRI | WQ_UNBOUND, SYNX_WQ_CLEANUP_THREADS);
  2189. if (!synx_dev->wq_cb || !synx_dev->wq_cleanup) {
  2190. dprintk(SYNX_ERR,
  2191. "high priority work queue creation failed\n");
  2192. rc = -SYNX_INVALID;
  2193. goto fail;
  2194. }
  2195. synx_dev->native = vzalloc(sizeof(*synx_dev->native));
  2196. if (IS_ERR_OR_NULL(synx_dev->native))
  2197. goto fail;
  2198. mutex_init(&synx_dev->vtbl_lock);
  2199. mutex_init(&synx_dev->error_lock);
  2200. INIT_LIST_HEAD(&synx_dev->error_list);
  2201. synx_dev->debugfs_root = synx_init_debugfs_dir(synx_dev);
  2202. rc = synx_global_mem_init();
  2203. if (rc) {
  2204. dprintk(SYNX_ERR, "shared mem init failed, err=%d\n", rc);
  2205. goto err;
  2206. }
  2207. synx_dev->cdsp_ssr.ssrcnt = 0;
  2208. synx_dev->cdsp_ssr.nb.notifier_call = synx_cdsp_restart_notifier;
  2209. synx_dev->cdsp_ssr.handle =
  2210. qcom_register_ssr_notifier("cdsp", &synx_dev->cdsp_ssr.nb);
  2211. if (synx_dev->cdsp_ssr.handle == NULL) {
  2212. dprintk(SYNX_ERR, "SSR registration failed\n");
  2213. goto err;
  2214. }
  2215. ipclite_register_client(synx_ipc_callback, NULL);
  2216. synx_local_mem_init();
  2217. dprintk(SYNX_INFO, "device initialization success\n");
  2218. return 0;
  2219. err:
  2220. vfree(synx_dev->native);
  2221. fail:
  2222. device_destroy(synx_dev->class, synx_dev->dev);
  2223. class_destroy(synx_dev->class);
  2224. reg_fail:
  2225. unregister_chrdev_region(synx_dev->dev, 1);
  2226. alloc_fail:
  2227. kfree(synx_dev);
  2228. synx_dev = NULL;
  2229. return rc;
  2230. }
  2231. static void __exit synx_exit(void)
  2232. {
  2233. struct error_node *err_node, *err_node_tmp;
  2234. flush_workqueue(synx_dev->wq_cb);
  2235. flush_workqueue(synx_dev->wq_cleanup);
  2236. device_destroy(synx_dev->class, synx_dev->dev);
  2237. class_destroy(synx_dev->class);
  2238. cdev_del(&synx_dev->cdev);
  2239. unregister_chrdev_region(synx_dev->dev, 1);
  2240. synx_remove_debugfs_dir(synx_dev);
  2241. /* release uncleared error nodes */
  2242. list_for_each_entry_safe(
  2243. err_node, err_node_tmp,
  2244. &synx_dev->error_list,
  2245. node) {
  2246. list_del(&err_node->node);
  2247. kfree(err_node);
  2248. }
  2249. mutex_destroy(&synx_dev->vtbl_lock);
  2250. mutex_destroy(&synx_dev->error_lock);
  2251. vfree(synx_dev->native);
  2252. kfree(synx_dev);
  2253. }
  2254. module_init(synx_init);
  2255. module_exit(synx_exit);
  2256. MODULE_DESCRIPTION("Global Synx Driver");
  2257. MODULE_LICENSE("GPL v2");