tee_core.c 38 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2015-2016, Linaro Limited
  4. */
  5. #define pr_fmt(fmt) "%s: " fmt, __func__
  6. #include <linux/cdev.h>
  7. #include <linux/cred.h>
  8. #include <linux/fs.h>
  9. #include <linux/idr.h>
  10. #include <linux/module.h>
  11. #include <linux/overflow.h>
  12. #include <linux/slab.h>
  13. #include <linux/tee_core.h>
  14. #include <linux/uaccess.h>
  15. #include <crypto/sha1.h>
  16. #include "tee_private.h"
  17. #define TEE_NUM_DEVICES 32
  18. #define TEE_IOCTL_PARAM_SIZE(x) (size_mul(sizeof(struct tee_param), (x)))
  19. #define TEE_UUID_NS_NAME_SIZE 128
  20. /*
  21. * TEE Client UUID name space identifier (UUIDv4)
  22. *
  23. * Value here is random UUID that is allocated as name space identifier for
  24. * forming Client UUID's for TEE environment using UUIDv5 scheme.
  25. */
  26. static const uuid_t tee_client_uuid_ns = UUID_INIT(0x58ac9ca0, 0x2086, 0x4683,
  27. 0xa1, 0xb8, 0xec, 0x4b,
  28. 0xc0, 0x8e, 0x01, 0xb6);
  29. /*
  30. * Unprivileged devices in the lower half range and privileged devices in
  31. * the upper half range.
  32. */
  33. static DECLARE_BITMAP(dev_mask, TEE_NUM_DEVICES);
  34. static DEFINE_SPINLOCK(driver_lock);
  35. static const struct class tee_class;
  36. static dev_t tee_devt;
  37. struct tee_context *teedev_open(struct tee_device *teedev)
  38. {
  39. int rc;
  40. struct tee_context *ctx;
  41. if (!tee_device_get(teedev))
  42. return ERR_PTR(-EINVAL);
  43. ctx = kzalloc_obj(*ctx);
  44. if (!ctx) {
  45. rc = -ENOMEM;
  46. goto err;
  47. }
  48. kref_init(&ctx->refcount);
  49. ctx->teedev = teedev;
  50. rc = teedev->desc->ops->open(ctx);
  51. if (rc)
  52. goto err;
  53. return ctx;
  54. err:
  55. kfree(ctx);
  56. tee_device_put(teedev);
  57. return ERR_PTR(rc);
  58. }
  59. EXPORT_SYMBOL_GPL(teedev_open);
  60. void teedev_ctx_get(struct tee_context *ctx)
  61. {
  62. if (ctx->releasing)
  63. return;
  64. kref_get(&ctx->refcount);
  65. }
  66. EXPORT_SYMBOL_GPL(teedev_ctx_get);
  67. static void teedev_ctx_release(struct kref *ref)
  68. {
  69. struct tee_context *ctx = container_of(ref, struct tee_context,
  70. refcount);
  71. ctx->releasing = true;
  72. ctx->teedev->desc->ops->release(ctx);
  73. kfree(ctx);
  74. }
  75. void teedev_ctx_put(struct tee_context *ctx)
  76. {
  77. if (ctx->releasing)
  78. return;
  79. kref_put(&ctx->refcount, teedev_ctx_release);
  80. }
  81. EXPORT_SYMBOL_GPL(teedev_ctx_put);
  82. void teedev_close_context(struct tee_context *ctx)
  83. {
  84. struct tee_device *teedev = ctx->teedev;
  85. if (teedev->desc->ops->close_context)
  86. teedev->desc->ops->close_context(ctx);
  87. teedev_ctx_put(ctx);
  88. tee_device_put(teedev);
  89. }
  90. EXPORT_SYMBOL_GPL(teedev_close_context);
  91. static int tee_open(struct inode *inode, struct file *filp)
  92. {
  93. struct tee_context *ctx;
  94. ctx = teedev_open(container_of(inode->i_cdev, struct tee_device, cdev));
  95. if (IS_ERR(ctx))
  96. return PTR_ERR(ctx);
  97. /*
  98. * Default user-space behaviour is to wait for tee-supplicant
  99. * if not present for any requests in this context.
  100. */
  101. ctx->supp_nowait = false;
  102. filp->private_data = ctx;
  103. return 0;
  104. }
  105. static int tee_release(struct inode *inode, struct file *filp)
  106. {
  107. teedev_close_context(filp->private_data);
  108. return 0;
  109. }
  110. /**
  111. * uuid_v5() - Calculate UUIDv5
  112. * @uuid: Resulting UUID
  113. * @ns: Name space ID for UUIDv5 function
  114. * @name: Name for UUIDv5 function
  115. * @size: Size of name
  116. *
  117. * UUIDv5 is specific in RFC 4122.
  118. *
  119. * This implements section (for SHA-1):
  120. * 4.3. Algorithm for Creating a Name-Based UUID
  121. */
  122. static void uuid_v5(uuid_t *uuid, const uuid_t *ns, const void *name,
  123. size_t size)
  124. {
  125. unsigned char hash[SHA1_DIGEST_SIZE];
  126. struct sha1_ctx ctx;
  127. sha1_init(&ctx);
  128. sha1_update(&ctx, (const u8 *)ns, sizeof(*ns));
  129. sha1_update(&ctx, (const u8 *)name, size);
  130. sha1_final(&ctx, hash);
  131. memcpy(uuid->b, hash, UUID_SIZE);
  132. /* Tag for version 5 */
  133. uuid->b[6] = (hash[6] & 0x0F) | 0x50;
  134. uuid->b[8] = (hash[8] & 0x3F) | 0x80;
  135. }
  136. int tee_session_calc_client_uuid(uuid_t *uuid, u32 connection_method,
  137. const u8 connection_data[TEE_IOCTL_UUID_LEN])
  138. {
  139. gid_t ns_grp = (gid_t)-1;
  140. kgid_t grp = INVALID_GID;
  141. char *name = NULL;
  142. int name_len;
  143. int rc = 0;
  144. if (connection_method == TEE_IOCTL_LOGIN_PUBLIC ||
  145. connection_method == TEE_IOCTL_LOGIN_REE_KERNEL) {
  146. /* Nil UUID to be passed to TEE environment */
  147. uuid_copy(uuid, &uuid_null);
  148. return 0;
  149. }
  150. /*
  151. * In Linux environment client UUID is based on UUIDv5.
  152. *
  153. * Determine client UUID with following semantics for 'name':
  154. *
  155. * For TEEC_LOGIN_USER:
  156. * uid=<uid>
  157. *
  158. * For TEEC_LOGIN_GROUP:
  159. * gid=<gid>
  160. *
  161. */
  162. name = kzalloc(TEE_UUID_NS_NAME_SIZE, GFP_KERNEL);
  163. if (!name)
  164. return -ENOMEM;
  165. switch (connection_method) {
  166. case TEE_IOCTL_LOGIN_USER:
  167. name_len = snprintf(name, TEE_UUID_NS_NAME_SIZE, "uid=%x",
  168. current_euid().val);
  169. if (name_len >= TEE_UUID_NS_NAME_SIZE) {
  170. rc = -E2BIG;
  171. goto out_free_name;
  172. }
  173. break;
  174. case TEE_IOCTL_LOGIN_GROUP:
  175. memcpy(&ns_grp, connection_data, sizeof(gid_t));
  176. grp = make_kgid(current_user_ns(), ns_grp);
  177. if (!gid_valid(grp) || !in_egroup_p(grp)) {
  178. rc = -EPERM;
  179. goto out_free_name;
  180. }
  181. name_len = snprintf(name, TEE_UUID_NS_NAME_SIZE, "gid=%x",
  182. grp.val);
  183. if (name_len >= TEE_UUID_NS_NAME_SIZE) {
  184. rc = -E2BIG;
  185. goto out_free_name;
  186. }
  187. break;
  188. default:
  189. rc = -EINVAL;
  190. goto out_free_name;
  191. }
  192. uuid_v5(uuid, &tee_client_uuid_ns, name, name_len);
  193. out_free_name:
  194. kfree(name);
  195. return rc;
  196. }
  197. EXPORT_SYMBOL_GPL(tee_session_calc_client_uuid);
  198. static int tee_ioctl_version(struct tee_context *ctx,
  199. struct tee_ioctl_version_data __user *uvers)
  200. {
  201. struct tee_ioctl_version_data vers;
  202. ctx->teedev->desc->ops->get_version(ctx->teedev, &vers);
  203. if (ctx->teedev->desc->flags & TEE_DESC_PRIVILEGED)
  204. vers.gen_caps |= TEE_GEN_CAP_PRIVILEGED;
  205. if (copy_to_user(uvers, &vers, sizeof(vers)))
  206. return -EFAULT;
  207. return 0;
  208. }
  209. static int tee_ioctl_shm_alloc(struct tee_context *ctx,
  210. struct tee_ioctl_shm_alloc_data __user *udata)
  211. {
  212. long ret;
  213. struct tee_ioctl_shm_alloc_data data;
  214. struct tee_shm *shm;
  215. if (copy_from_user(&data, udata, sizeof(data)))
  216. return -EFAULT;
  217. /* Currently no input flags are supported */
  218. if (data.flags)
  219. return -EINVAL;
  220. shm = tee_shm_alloc_user_buf(ctx, data.size);
  221. if (IS_ERR(shm))
  222. return PTR_ERR(shm);
  223. data.id = shm->id;
  224. data.size = shm->size;
  225. if (copy_to_user(udata, &data, sizeof(data)))
  226. ret = -EFAULT;
  227. else
  228. ret = tee_shm_get_fd(shm);
  229. /*
  230. * When user space closes the file descriptor the shared memory
  231. * should be freed or if tee_shm_get_fd() failed then it will
  232. * be freed immediately.
  233. */
  234. tee_shm_put(shm);
  235. return ret;
  236. }
  237. static int
  238. tee_ioctl_shm_register(struct tee_context *ctx,
  239. struct tee_ioctl_shm_register_data __user *udata)
  240. {
  241. long ret;
  242. struct tee_ioctl_shm_register_data data;
  243. struct tee_shm *shm;
  244. if (copy_from_user(&data, udata, sizeof(data)))
  245. return -EFAULT;
  246. /* Currently no input flags are supported */
  247. if (data.flags)
  248. return -EINVAL;
  249. shm = tee_shm_register_user_buf(ctx, data.addr, data.length);
  250. if (IS_ERR(shm))
  251. return PTR_ERR(shm);
  252. data.id = shm->id;
  253. data.length = shm->size;
  254. if (copy_to_user(udata, &data, sizeof(data)))
  255. ret = -EFAULT;
  256. else
  257. ret = tee_shm_get_fd(shm);
  258. /*
  259. * When user space closes the file descriptor the shared memory
  260. * should be freed or if tee_shm_get_fd() failed then it will
  261. * be freed immediately.
  262. */
  263. tee_shm_put(shm);
  264. return ret;
  265. }
  266. static int
  267. tee_ioctl_shm_register_fd(struct tee_context *ctx,
  268. struct tee_ioctl_shm_register_fd_data __user *udata)
  269. {
  270. struct tee_ioctl_shm_register_fd_data data;
  271. struct tee_shm *shm;
  272. long ret;
  273. if (copy_from_user(&data, udata, sizeof(data)))
  274. return -EFAULT;
  275. /* Currently no input flags are supported */
  276. if (data.flags)
  277. return -EINVAL;
  278. shm = tee_shm_register_fd(ctx, data.fd);
  279. if (IS_ERR(shm))
  280. return -EINVAL;
  281. data.id = shm->id;
  282. data.flags = shm->flags;
  283. data.size = shm->size;
  284. if (copy_to_user(udata, &data, sizeof(data)))
  285. ret = -EFAULT;
  286. else
  287. ret = tee_shm_get_fd(shm);
  288. /*
  289. * When user space closes the file descriptor the shared memory
  290. * should be freed or if tee_shm_get_fd() failed then it will
  291. * be freed immediately.
  292. */
  293. tee_shm_put(shm);
  294. return ret;
  295. }
  296. static int param_from_user_memref(struct tee_context *ctx,
  297. struct tee_param_memref *memref,
  298. struct tee_ioctl_param *ip)
  299. {
  300. struct tee_shm *shm;
  301. size_t offs = 0;
  302. /*
  303. * If a NULL pointer is passed to a TA in the TEE,
  304. * the ip.c IOCTL parameters is set to TEE_MEMREF_NULL
  305. * indicating a NULL memory reference.
  306. */
  307. if (ip->c != TEE_MEMREF_NULL) {
  308. /*
  309. * If we fail to get a pointer to a shared
  310. * memory object (and increase the ref count)
  311. * from an identifier we return an error. All
  312. * pointers that has been added in params have
  313. * an increased ref count. It's the callers
  314. * responibility to do tee_shm_put() on all
  315. * resolved pointers.
  316. */
  317. shm = tee_shm_get_from_id(ctx, ip->c);
  318. if (IS_ERR(shm))
  319. return PTR_ERR(shm);
  320. /*
  321. * Ensure offset + size does not overflow
  322. * offset and does not overflow the size of
  323. * the referred shared memory object.
  324. */
  325. if ((ip->a + ip->b) < ip->a ||
  326. (ip->a + ip->b) > shm->size) {
  327. tee_shm_put(shm);
  328. return -EINVAL;
  329. }
  330. if (shm->flags & TEE_SHM_DMA_BUF) {
  331. struct tee_shm_dmabuf_ref *ref;
  332. ref = container_of(shm, struct tee_shm_dmabuf_ref, shm);
  333. if (ref->parent_shm) {
  334. /*
  335. * The shm already has one reference to
  336. * ref->parent_shm so we are clear of 0.
  337. * We're getting another reference since
  338. * this shm will be used in the parameter
  339. * list instead of the shm we got with
  340. * tee_shm_get_from_id() above.
  341. */
  342. refcount_inc(&ref->parent_shm->refcount);
  343. tee_shm_put(shm);
  344. shm = ref->parent_shm;
  345. offs = ref->offset;
  346. }
  347. }
  348. } else if (ctx->cap_memref_null) {
  349. /* Pass NULL pointer to OP-TEE */
  350. shm = NULL;
  351. } else {
  352. return -EINVAL;
  353. }
  354. memref->shm_offs = ip->a + offs;
  355. memref->size = ip->b;
  356. memref->shm = shm;
  357. return 0;
  358. }
  359. static int params_from_user(struct tee_context *ctx, struct tee_param *params,
  360. size_t num_params,
  361. struct tee_ioctl_param __user *uparams)
  362. {
  363. size_t n;
  364. for (n = 0; n < num_params; n++) {
  365. struct tee_ioctl_param ip;
  366. int rc;
  367. if (copy_from_user(&ip, uparams + n, sizeof(ip)))
  368. return -EFAULT;
  369. /* All unused attribute bits has to be zero */
  370. if (ip.attr & ~TEE_IOCTL_PARAM_ATTR_MASK)
  371. return -EINVAL;
  372. params[n].attr = ip.attr;
  373. switch (ip.attr & TEE_IOCTL_PARAM_ATTR_TYPE_MASK) {
  374. case TEE_IOCTL_PARAM_ATTR_TYPE_NONE:
  375. case TEE_IOCTL_PARAM_ATTR_TYPE_VALUE_OUTPUT:
  376. case TEE_IOCTL_PARAM_ATTR_TYPE_OBJREF_OUTPUT:
  377. break;
  378. case TEE_IOCTL_PARAM_ATTR_TYPE_VALUE_INPUT:
  379. case TEE_IOCTL_PARAM_ATTR_TYPE_VALUE_INOUT:
  380. params[n].u.value.a = ip.a;
  381. params[n].u.value.b = ip.b;
  382. params[n].u.value.c = ip.c;
  383. break;
  384. case TEE_IOCTL_PARAM_ATTR_TYPE_UBUF_INPUT:
  385. case TEE_IOCTL_PARAM_ATTR_TYPE_UBUF_OUTPUT:
  386. case TEE_IOCTL_PARAM_ATTR_TYPE_UBUF_INOUT:
  387. params[n].u.ubuf.uaddr = u64_to_user_ptr(ip.a);
  388. params[n].u.ubuf.size = ip.b;
  389. if (!access_ok(params[n].u.ubuf.uaddr,
  390. params[n].u.ubuf.size))
  391. return -EFAULT;
  392. break;
  393. case TEE_IOCTL_PARAM_ATTR_TYPE_OBJREF_INPUT:
  394. case TEE_IOCTL_PARAM_ATTR_TYPE_OBJREF_INOUT:
  395. params[n].u.objref.id = ip.a;
  396. params[n].u.objref.flags = ip.b;
  397. break;
  398. case TEE_IOCTL_PARAM_ATTR_TYPE_MEMREF_INPUT:
  399. case TEE_IOCTL_PARAM_ATTR_TYPE_MEMREF_OUTPUT:
  400. case TEE_IOCTL_PARAM_ATTR_TYPE_MEMREF_INOUT:
  401. rc = param_from_user_memref(ctx, &params[n].u.memref,
  402. &ip);
  403. if (rc)
  404. return rc;
  405. break;
  406. default:
  407. /* Unknown attribute */
  408. return -EINVAL;
  409. }
  410. }
  411. return 0;
  412. }
  413. static int params_to_user(struct tee_ioctl_param __user *uparams,
  414. size_t num_params, struct tee_param *params)
  415. {
  416. size_t n;
  417. for (n = 0; n < num_params; n++) {
  418. struct tee_ioctl_param __user *up = uparams + n;
  419. struct tee_param *p = params + n;
  420. switch (p->attr) {
  421. case TEE_IOCTL_PARAM_ATTR_TYPE_VALUE_OUTPUT:
  422. case TEE_IOCTL_PARAM_ATTR_TYPE_VALUE_INOUT:
  423. if (put_user(p->u.value.a, &up->a) ||
  424. put_user(p->u.value.b, &up->b) ||
  425. put_user(p->u.value.c, &up->c))
  426. return -EFAULT;
  427. break;
  428. case TEE_IOCTL_PARAM_ATTR_TYPE_UBUF_OUTPUT:
  429. case TEE_IOCTL_PARAM_ATTR_TYPE_UBUF_INOUT:
  430. if (put_user((u64)p->u.ubuf.size, &up->b))
  431. return -EFAULT;
  432. break;
  433. case TEE_IOCTL_PARAM_ATTR_TYPE_OBJREF_OUTPUT:
  434. case TEE_IOCTL_PARAM_ATTR_TYPE_OBJREF_INOUT:
  435. if (put_user(p->u.objref.id, &up->a) ||
  436. put_user(p->u.objref.flags, &up->b))
  437. return -EFAULT;
  438. break;
  439. case TEE_IOCTL_PARAM_ATTR_TYPE_MEMREF_OUTPUT:
  440. case TEE_IOCTL_PARAM_ATTR_TYPE_MEMREF_INOUT:
  441. if (put_user((u64)p->u.memref.size, &up->b))
  442. return -EFAULT;
  443. break;
  444. default:
  445. break;
  446. }
  447. }
  448. return 0;
  449. }
  450. static int tee_ioctl_open_session(struct tee_context *ctx,
  451. struct tee_ioctl_buf_data __user *ubuf)
  452. {
  453. int rc;
  454. size_t n;
  455. struct tee_ioctl_buf_data buf;
  456. struct tee_ioctl_open_session_arg __user *uarg;
  457. struct tee_ioctl_open_session_arg arg;
  458. struct tee_ioctl_param __user *uparams = NULL;
  459. struct tee_param *params = NULL;
  460. bool have_session = false;
  461. if (!ctx->teedev->desc->ops->open_session)
  462. return -EINVAL;
  463. if (copy_from_user(&buf, ubuf, sizeof(buf)))
  464. return -EFAULT;
  465. if (buf.buf_len > TEE_MAX_ARG_SIZE ||
  466. buf.buf_len < sizeof(struct tee_ioctl_open_session_arg))
  467. return -EINVAL;
  468. uarg = u64_to_user_ptr(buf.buf_ptr);
  469. if (copy_from_user(&arg, uarg, sizeof(arg)))
  470. return -EFAULT;
  471. if (size_add(sizeof(arg), TEE_IOCTL_PARAM_SIZE(arg.num_params)) != buf.buf_len)
  472. return -EINVAL;
  473. if (arg.num_params) {
  474. params = kzalloc_objs(struct tee_param, arg.num_params);
  475. if (!params)
  476. return -ENOMEM;
  477. uparams = uarg->params;
  478. rc = params_from_user(ctx, params, arg.num_params, uparams);
  479. if (rc)
  480. goto out;
  481. }
  482. if (arg.clnt_login >= TEE_IOCTL_LOGIN_REE_KERNEL_MIN &&
  483. arg.clnt_login <= TEE_IOCTL_LOGIN_REE_KERNEL_MAX) {
  484. pr_debug("login method not allowed for user-space client\n");
  485. rc = -EPERM;
  486. goto out;
  487. }
  488. rc = ctx->teedev->desc->ops->open_session(ctx, &arg, params);
  489. if (rc)
  490. goto out;
  491. have_session = true;
  492. if (put_user(arg.session, &uarg->session) ||
  493. put_user(arg.ret, &uarg->ret) ||
  494. put_user(arg.ret_origin, &uarg->ret_origin)) {
  495. rc = -EFAULT;
  496. goto out;
  497. }
  498. rc = params_to_user(uparams, arg.num_params, params);
  499. out:
  500. /*
  501. * If we've succeeded to open the session but failed to communicate
  502. * it back to user space, close the session again to avoid leakage.
  503. */
  504. if (rc && have_session && ctx->teedev->desc->ops->close_session)
  505. ctx->teedev->desc->ops->close_session(ctx, arg.session);
  506. if (params) {
  507. /* Decrease ref count for all valid shared memory pointers */
  508. for (n = 0; n < arg.num_params; n++)
  509. if (tee_param_is_memref(params + n) &&
  510. params[n].u.memref.shm)
  511. tee_shm_put(params[n].u.memref.shm);
  512. kfree(params);
  513. }
  514. return rc;
  515. }
  516. static int tee_ioctl_invoke(struct tee_context *ctx,
  517. struct tee_ioctl_buf_data __user *ubuf)
  518. {
  519. int rc;
  520. size_t n;
  521. struct tee_ioctl_buf_data buf;
  522. struct tee_ioctl_invoke_arg __user *uarg;
  523. struct tee_ioctl_invoke_arg arg;
  524. struct tee_ioctl_param __user *uparams = NULL;
  525. struct tee_param *params = NULL;
  526. if (!ctx->teedev->desc->ops->invoke_func)
  527. return -EINVAL;
  528. if (copy_from_user(&buf, ubuf, sizeof(buf)))
  529. return -EFAULT;
  530. if (buf.buf_len > TEE_MAX_ARG_SIZE ||
  531. buf.buf_len < sizeof(struct tee_ioctl_invoke_arg))
  532. return -EINVAL;
  533. uarg = u64_to_user_ptr(buf.buf_ptr);
  534. if (copy_from_user(&arg, uarg, sizeof(arg)))
  535. return -EFAULT;
  536. if (size_add(sizeof(arg), TEE_IOCTL_PARAM_SIZE(arg.num_params)) != buf.buf_len)
  537. return -EINVAL;
  538. if (arg.num_params) {
  539. params = kzalloc_objs(struct tee_param, arg.num_params);
  540. if (!params)
  541. return -ENOMEM;
  542. uparams = uarg->params;
  543. rc = params_from_user(ctx, params, arg.num_params, uparams);
  544. if (rc)
  545. goto out;
  546. }
  547. rc = ctx->teedev->desc->ops->invoke_func(ctx, &arg, params);
  548. if (rc)
  549. goto out;
  550. if (put_user(arg.ret, &uarg->ret) ||
  551. put_user(arg.ret_origin, &uarg->ret_origin)) {
  552. rc = -EFAULT;
  553. goto out;
  554. }
  555. rc = params_to_user(uparams, arg.num_params, params);
  556. out:
  557. if (params) {
  558. /* Decrease ref count for all valid shared memory pointers */
  559. for (n = 0; n < arg.num_params; n++)
  560. if (tee_param_is_memref(params + n) &&
  561. params[n].u.memref.shm)
  562. tee_shm_put(params[n].u.memref.shm);
  563. kfree(params);
  564. }
  565. return rc;
  566. }
  567. static int tee_ioctl_object_invoke(struct tee_context *ctx,
  568. struct tee_ioctl_buf_data __user *ubuf)
  569. {
  570. int rc;
  571. size_t n;
  572. struct tee_ioctl_buf_data buf;
  573. struct tee_ioctl_object_invoke_arg __user *uarg;
  574. struct tee_ioctl_object_invoke_arg arg;
  575. struct tee_ioctl_param __user *uparams = NULL;
  576. struct tee_param *params = NULL;
  577. if (!ctx->teedev->desc->ops->object_invoke_func)
  578. return -EINVAL;
  579. if (copy_from_user(&buf, ubuf, sizeof(buf)))
  580. return -EFAULT;
  581. if (buf.buf_len > TEE_MAX_ARG_SIZE ||
  582. buf.buf_len < sizeof(struct tee_ioctl_object_invoke_arg))
  583. return -EINVAL;
  584. uarg = u64_to_user_ptr(buf.buf_ptr);
  585. if (copy_from_user(&arg, uarg, sizeof(arg)))
  586. return -EFAULT;
  587. if (sizeof(arg) + TEE_IOCTL_PARAM_SIZE(arg.num_params) != buf.buf_len)
  588. return -EINVAL;
  589. if (arg.num_params) {
  590. params = kzalloc_objs(struct tee_param, arg.num_params);
  591. if (!params)
  592. return -ENOMEM;
  593. uparams = uarg->params;
  594. rc = params_from_user(ctx, params, arg.num_params, uparams);
  595. if (rc)
  596. goto out;
  597. }
  598. rc = ctx->teedev->desc->ops->object_invoke_func(ctx, &arg, params);
  599. if (rc)
  600. goto out;
  601. if (put_user(arg.ret, &uarg->ret)) {
  602. rc = -EFAULT;
  603. goto out;
  604. }
  605. rc = params_to_user(uparams, arg.num_params, params);
  606. out:
  607. if (params) {
  608. /* Decrease ref count for all valid shared memory pointers */
  609. for (n = 0; n < arg.num_params; n++)
  610. if (tee_param_is_memref(params + n) &&
  611. params[n].u.memref.shm)
  612. tee_shm_put(params[n].u.memref.shm);
  613. kfree(params);
  614. }
  615. return rc;
  616. }
  617. static int tee_ioctl_cancel(struct tee_context *ctx,
  618. struct tee_ioctl_cancel_arg __user *uarg)
  619. {
  620. struct tee_ioctl_cancel_arg arg;
  621. if (!ctx->teedev->desc->ops->cancel_req)
  622. return -EINVAL;
  623. if (copy_from_user(&arg, uarg, sizeof(arg)))
  624. return -EFAULT;
  625. return ctx->teedev->desc->ops->cancel_req(ctx, arg.cancel_id,
  626. arg.session);
  627. }
  628. static int
  629. tee_ioctl_close_session(struct tee_context *ctx,
  630. struct tee_ioctl_close_session_arg __user *uarg)
  631. {
  632. struct tee_ioctl_close_session_arg arg;
  633. if (!ctx->teedev->desc->ops->close_session)
  634. return -EINVAL;
  635. if (copy_from_user(&arg, uarg, sizeof(arg)))
  636. return -EFAULT;
  637. return ctx->teedev->desc->ops->close_session(ctx, arg.session);
  638. }
  639. static int params_to_supp(struct tee_context *ctx,
  640. struct tee_ioctl_param __user *uparams,
  641. size_t num_params, struct tee_param *params)
  642. {
  643. size_t n;
  644. for (n = 0; n < num_params; n++) {
  645. struct tee_ioctl_param ip;
  646. struct tee_param *p = params + n;
  647. ip.attr = p->attr;
  648. switch (p->attr & TEE_IOCTL_PARAM_ATTR_TYPE_MASK) {
  649. case TEE_IOCTL_PARAM_ATTR_TYPE_VALUE_INPUT:
  650. case TEE_IOCTL_PARAM_ATTR_TYPE_VALUE_INOUT:
  651. ip.a = p->u.value.a;
  652. ip.b = p->u.value.b;
  653. ip.c = p->u.value.c;
  654. break;
  655. case TEE_IOCTL_PARAM_ATTR_TYPE_UBUF_INPUT:
  656. case TEE_IOCTL_PARAM_ATTR_TYPE_UBUF_OUTPUT:
  657. case TEE_IOCTL_PARAM_ATTR_TYPE_UBUF_INOUT:
  658. ip.a = (__force unsigned long)p->u.ubuf.uaddr;
  659. ip.b = p->u.ubuf.size;
  660. ip.c = 0;
  661. break;
  662. case TEE_IOCTL_PARAM_ATTR_TYPE_OBJREF_INPUT:
  663. case TEE_IOCTL_PARAM_ATTR_TYPE_OBJREF_INOUT:
  664. ip.a = p->u.objref.id;
  665. ip.b = p->u.objref.flags;
  666. ip.c = 0;
  667. break;
  668. case TEE_IOCTL_PARAM_ATTR_TYPE_MEMREF_INPUT:
  669. case TEE_IOCTL_PARAM_ATTR_TYPE_MEMREF_OUTPUT:
  670. case TEE_IOCTL_PARAM_ATTR_TYPE_MEMREF_INOUT:
  671. ip.b = p->u.memref.size;
  672. if (!p->u.memref.shm) {
  673. ip.a = 0;
  674. ip.c = (u64)-1; /* invalid shm id */
  675. break;
  676. }
  677. ip.a = p->u.memref.shm_offs;
  678. ip.c = p->u.memref.shm->id;
  679. break;
  680. default:
  681. ip.a = 0;
  682. ip.b = 0;
  683. ip.c = 0;
  684. break;
  685. }
  686. if (copy_to_user(uparams + n, &ip, sizeof(ip)))
  687. return -EFAULT;
  688. }
  689. return 0;
  690. }
  691. static int tee_ioctl_supp_recv(struct tee_context *ctx,
  692. struct tee_ioctl_buf_data __user *ubuf)
  693. {
  694. int rc;
  695. struct tee_ioctl_buf_data buf;
  696. struct tee_iocl_supp_recv_arg __user *uarg;
  697. struct tee_param *params;
  698. u32 num_params;
  699. u32 func;
  700. if (!ctx->teedev->desc->ops->supp_recv)
  701. return -EINVAL;
  702. if (copy_from_user(&buf, ubuf, sizeof(buf)))
  703. return -EFAULT;
  704. if (buf.buf_len > TEE_MAX_ARG_SIZE ||
  705. buf.buf_len < sizeof(struct tee_iocl_supp_recv_arg))
  706. return -EINVAL;
  707. uarg = u64_to_user_ptr(buf.buf_ptr);
  708. if (get_user(num_params, &uarg->num_params))
  709. return -EFAULT;
  710. if (size_add(sizeof(*uarg), TEE_IOCTL_PARAM_SIZE(num_params)) != buf.buf_len)
  711. return -EINVAL;
  712. params = kzalloc_objs(struct tee_param, num_params);
  713. if (!params)
  714. return -ENOMEM;
  715. rc = params_from_user(ctx, params, num_params, uarg->params);
  716. if (rc)
  717. goto out;
  718. rc = ctx->teedev->desc->ops->supp_recv(ctx, &func, &num_params, params);
  719. if (rc)
  720. goto out;
  721. if (put_user(func, &uarg->func) ||
  722. put_user(num_params, &uarg->num_params)) {
  723. rc = -EFAULT;
  724. goto out;
  725. }
  726. rc = params_to_supp(ctx, uarg->params, num_params, params);
  727. out:
  728. kfree(params);
  729. return rc;
  730. }
  731. static int params_from_supp(struct tee_param *params, size_t num_params,
  732. struct tee_ioctl_param __user *uparams)
  733. {
  734. size_t n;
  735. for (n = 0; n < num_params; n++) {
  736. struct tee_param *p = params + n;
  737. struct tee_ioctl_param ip;
  738. if (copy_from_user(&ip, uparams + n, sizeof(ip)))
  739. return -EFAULT;
  740. /* All unused attribute bits has to be zero */
  741. if (ip.attr & ~TEE_IOCTL_PARAM_ATTR_MASK)
  742. return -EINVAL;
  743. p->attr = ip.attr;
  744. switch (ip.attr & TEE_IOCTL_PARAM_ATTR_TYPE_MASK) {
  745. case TEE_IOCTL_PARAM_ATTR_TYPE_VALUE_OUTPUT:
  746. case TEE_IOCTL_PARAM_ATTR_TYPE_VALUE_INOUT:
  747. /* Only out and in/out values can be updated */
  748. p->u.value.a = ip.a;
  749. p->u.value.b = ip.b;
  750. p->u.value.c = ip.c;
  751. break;
  752. case TEE_IOCTL_PARAM_ATTR_TYPE_UBUF_OUTPUT:
  753. case TEE_IOCTL_PARAM_ATTR_TYPE_UBUF_INOUT:
  754. p->u.ubuf.uaddr = u64_to_user_ptr(ip.a);
  755. p->u.ubuf.size = ip.b;
  756. if (!access_ok(params[n].u.ubuf.uaddr,
  757. params[n].u.ubuf.size))
  758. return -EFAULT;
  759. break;
  760. case TEE_IOCTL_PARAM_ATTR_TYPE_OBJREF_OUTPUT:
  761. case TEE_IOCTL_PARAM_ATTR_TYPE_OBJREF_INOUT:
  762. p->u.objref.id = ip.a;
  763. p->u.objref.flags = ip.b;
  764. break;
  765. case TEE_IOCTL_PARAM_ATTR_TYPE_MEMREF_OUTPUT:
  766. case TEE_IOCTL_PARAM_ATTR_TYPE_MEMREF_INOUT:
  767. /*
  768. * Only the size of the memref can be updated.
  769. * Since we don't have access to the original
  770. * parameters here, only store the supplied size.
  771. * The driver will copy the updated size into the
  772. * original parameters.
  773. */
  774. p->u.memref.shm = NULL;
  775. p->u.memref.shm_offs = 0;
  776. p->u.memref.size = ip.b;
  777. break;
  778. default:
  779. memset(&p->u, 0, sizeof(p->u));
  780. break;
  781. }
  782. }
  783. return 0;
  784. }
  785. static int tee_ioctl_supp_send(struct tee_context *ctx,
  786. struct tee_ioctl_buf_data __user *ubuf)
  787. {
  788. long rc;
  789. struct tee_ioctl_buf_data buf;
  790. struct tee_iocl_supp_send_arg __user *uarg;
  791. struct tee_param *params;
  792. u32 num_params;
  793. u32 ret;
  794. /* Not valid for this driver */
  795. if (!ctx->teedev->desc->ops->supp_send)
  796. return -EINVAL;
  797. if (copy_from_user(&buf, ubuf, sizeof(buf)))
  798. return -EFAULT;
  799. if (buf.buf_len > TEE_MAX_ARG_SIZE ||
  800. buf.buf_len < sizeof(struct tee_iocl_supp_send_arg))
  801. return -EINVAL;
  802. uarg = u64_to_user_ptr(buf.buf_ptr);
  803. if (get_user(ret, &uarg->ret) ||
  804. get_user(num_params, &uarg->num_params))
  805. return -EFAULT;
  806. if (size_add(sizeof(*uarg), TEE_IOCTL_PARAM_SIZE(num_params)) > buf.buf_len)
  807. return -EINVAL;
  808. params = kzalloc_objs(struct tee_param, num_params);
  809. if (!params)
  810. return -ENOMEM;
  811. rc = params_from_supp(params, num_params, uarg->params);
  812. if (rc)
  813. goto out;
  814. rc = ctx->teedev->desc->ops->supp_send(ctx, ret, num_params, params);
  815. out:
  816. kfree(params);
  817. return rc;
  818. }
  819. static long tee_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
  820. {
  821. struct tee_context *ctx = filp->private_data;
  822. void __user *uarg = (void __user *)arg;
  823. switch (cmd) {
  824. case TEE_IOC_VERSION:
  825. return tee_ioctl_version(ctx, uarg);
  826. case TEE_IOC_SHM_ALLOC:
  827. return tee_ioctl_shm_alloc(ctx, uarg);
  828. case TEE_IOC_SHM_REGISTER:
  829. return tee_ioctl_shm_register(ctx, uarg);
  830. case TEE_IOC_SHM_REGISTER_FD:
  831. return tee_ioctl_shm_register_fd(ctx, uarg);
  832. case TEE_IOC_OPEN_SESSION:
  833. return tee_ioctl_open_session(ctx, uarg);
  834. case TEE_IOC_INVOKE:
  835. return tee_ioctl_invoke(ctx, uarg);
  836. case TEE_IOC_OBJECT_INVOKE:
  837. return tee_ioctl_object_invoke(ctx, uarg);
  838. case TEE_IOC_CANCEL:
  839. return tee_ioctl_cancel(ctx, uarg);
  840. case TEE_IOC_CLOSE_SESSION:
  841. return tee_ioctl_close_session(ctx, uarg);
  842. case TEE_IOC_SUPPL_RECV:
  843. return tee_ioctl_supp_recv(ctx, uarg);
  844. case TEE_IOC_SUPPL_SEND:
  845. return tee_ioctl_supp_send(ctx, uarg);
  846. default:
  847. return -EINVAL;
  848. }
  849. }
  850. static const struct file_operations tee_fops = {
  851. .owner = THIS_MODULE,
  852. .open = tee_open,
  853. .release = tee_release,
  854. .unlocked_ioctl = tee_ioctl,
  855. .compat_ioctl = compat_ptr_ioctl,
  856. };
  857. static void tee_release_device(struct device *dev)
  858. {
  859. struct tee_device *teedev = container_of(dev, struct tee_device, dev);
  860. spin_lock(&driver_lock);
  861. clear_bit(teedev->id, dev_mask);
  862. spin_unlock(&driver_lock);
  863. mutex_destroy(&teedev->mutex);
  864. idr_destroy(&teedev->idr);
  865. kfree(teedev);
  866. }
  867. /**
  868. * tee_device_alloc() - Allocate a new struct tee_device instance
  869. * @teedesc: Descriptor for this driver
  870. * @dev: Parent device for this device
  871. * @pool: Shared memory pool, NULL if not used
  872. * @driver_data: Private driver data for this device
  873. *
  874. * Allocates a new struct tee_device instance. The device is
  875. * removed by tee_device_unregister().
  876. *
  877. * @returns a pointer to a 'struct tee_device' or an ERR_PTR on failure
  878. */
  879. struct tee_device *tee_device_alloc(const struct tee_desc *teedesc,
  880. struct device *dev,
  881. struct tee_shm_pool *pool,
  882. void *driver_data)
  883. {
  884. struct tee_device *teedev;
  885. void *ret;
  886. int rc, max_id;
  887. int offs = 0;
  888. if (!teedesc || !teedesc->name || !teedesc->ops ||
  889. !teedesc->ops->get_version || !teedesc->ops->open ||
  890. !teedesc->ops->release)
  891. return ERR_PTR(-EINVAL);
  892. teedev = kzalloc_obj(*teedev);
  893. if (!teedev) {
  894. ret = ERR_PTR(-ENOMEM);
  895. goto err;
  896. }
  897. max_id = TEE_NUM_DEVICES / 2;
  898. if (teedesc->flags & TEE_DESC_PRIVILEGED) {
  899. offs = TEE_NUM_DEVICES / 2;
  900. max_id = TEE_NUM_DEVICES;
  901. }
  902. spin_lock(&driver_lock);
  903. teedev->id = find_next_zero_bit(dev_mask, max_id, offs);
  904. if (teedev->id < max_id)
  905. set_bit(teedev->id, dev_mask);
  906. spin_unlock(&driver_lock);
  907. if (teedev->id >= max_id) {
  908. ret = ERR_PTR(-ENOMEM);
  909. goto err;
  910. }
  911. snprintf(teedev->name, sizeof(teedev->name), "tee%s%d",
  912. teedesc->flags & TEE_DESC_PRIVILEGED ? "priv" : "",
  913. teedev->id - offs);
  914. teedev->dev.class = &tee_class;
  915. teedev->dev.release = tee_release_device;
  916. teedev->dev.parent = dev;
  917. teedev->dev.devt = MKDEV(MAJOR(tee_devt), teedev->id);
  918. rc = dev_set_name(&teedev->dev, "%s", teedev->name);
  919. if (rc) {
  920. ret = ERR_PTR(rc);
  921. goto err_devt;
  922. }
  923. cdev_init(&teedev->cdev, &tee_fops);
  924. teedev->cdev.owner = teedesc->owner;
  925. dev_set_drvdata(&teedev->dev, driver_data);
  926. device_initialize(&teedev->dev);
  927. /* 1 as tee_device_unregister() does one final tee_device_put() */
  928. teedev->num_users = 1;
  929. init_completion(&teedev->c_no_users);
  930. mutex_init(&teedev->mutex);
  931. idr_init(&teedev->idr);
  932. teedev->desc = teedesc;
  933. teedev->pool = pool;
  934. return teedev;
  935. err_devt:
  936. unregister_chrdev_region(teedev->dev.devt, 1);
  937. err:
  938. pr_err("could not register %s driver\n",
  939. teedesc->flags & TEE_DESC_PRIVILEGED ? "privileged" : "client");
  940. if (teedev && teedev->id < TEE_NUM_DEVICES) {
  941. spin_lock(&driver_lock);
  942. clear_bit(teedev->id, dev_mask);
  943. spin_unlock(&driver_lock);
  944. }
  945. kfree(teedev);
  946. return ret;
  947. }
  948. EXPORT_SYMBOL_GPL(tee_device_alloc);
  949. void tee_device_set_dev_groups(struct tee_device *teedev,
  950. const struct attribute_group **dev_groups)
  951. {
  952. teedev->dev.groups = dev_groups;
  953. }
  954. EXPORT_SYMBOL_GPL(tee_device_set_dev_groups);
  955. static ssize_t implementation_id_show(struct device *dev,
  956. struct device_attribute *attr, char *buf)
  957. {
  958. struct tee_device *teedev = container_of(dev, struct tee_device, dev);
  959. struct tee_ioctl_version_data vers;
  960. teedev->desc->ops->get_version(teedev, &vers);
  961. return sysfs_emit(buf, "%d\n", vers.impl_id);
  962. }
  963. static DEVICE_ATTR_RO(implementation_id);
  964. static struct attribute *tee_dev_attrs[] = {
  965. &dev_attr_implementation_id.attr,
  966. NULL
  967. };
  968. static const struct attribute_group tee_dev_group = {
  969. .attrs = tee_dev_attrs,
  970. };
  971. static ssize_t revision_show(struct device *dev,
  972. struct device_attribute *attr, char *buf)
  973. {
  974. struct tee_device *teedev = container_of(dev, struct tee_device, dev);
  975. char version[TEE_REVISION_STR_SIZE];
  976. int ret;
  977. if (!teedev->desc->ops->get_tee_revision)
  978. return -ENODEV;
  979. ret = teedev->desc->ops->get_tee_revision(teedev, version,
  980. sizeof(version));
  981. if (ret)
  982. return ret;
  983. return sysfs_emit(buf, "%s\n", version);
  984. }
  985. static DEVICE_ATTR_RO(revision);
  986. static struct attribute *tee_revision_attrs[] = {
  987. &dev_attr_revision.attr,
  988. NULL
  989. };
  990. static umode_t tee_revision_attr_is_visible(struct kobject *kobj,
  991. struct attribute *attr, int n)
  992. {
  993. struct device *dev = kobj_to_dev(kobj);
  994. struct tee_device *teedev = container_of(dev, struct tee_device, dev);
  995. if (teedev->desc->ops->get_tee_revision)
  996. return attr->mode;
  997. return 0;
  998. }
  999. static const struct attribute_group tee_revision_group = {
  1000. .attrs = tee_revision_attrs,
  1001. .is_visible = tee_revision_attr_is_visible,
  1002. };
  1003. static const struct attribute_group *tee_dev_groups[] = {
  1004. &tee_dev_group,
  1005. &tee_revision_group,
  1006. NULL
  1007. };
  1008. static const struct class tee_class = {
  1009. .name = "tee",
  1010. .dev_groups = tee_dev_groups,
  1011. };
  1012. /**
  1013. * tee_device_register() - Registers a TEE device
  1014. * @teedev: Device to register
  1015. *
  1016. * tee_device_unregister() need to be called to remove the @teedev if
  1017. * this function fails.
  1018. *
  1019. * @returns < 0 on failure
  1020. */
  1021. int tee_device_register(struct tee_device *teedev)
  1022. {
  1023. int rc;
  1024. if (teedev->flags & TEE_DEVICE_FLAG_REGISTERED) {
  1025. dev_err(&teedev->dev, "attempt to register twice\n");
  1026. return -EINVAL;
  1027. }
  1028. rc = cdev_device_add(&teedev->cdev, &teedev->dev);
  1029. if (rc) {
  1030. dev_err(&teedev->dev,
  1031. "unable to cdev_device_add() %s, major %d, minor %d, err=%d\n",
  1032. teedev->name, MAJOR(teedev->dev.devt),
  1033. MINOR(teedev->dev.devt), rc);
  1034. return rc;
  1035. }
  1036. teedev->flags |= TEE_DEVICE_FLAG_REGISTERED;
  1037. return 0;
  1038. }
  1039. EXPORT_SYMBOL_GPL(tee_device_register);
  1040. void tee_device_put(struct tee_device *teedev)
  1041. {
  1042. mutex_lock(&teedev->mutex);
  1043. /* Shouldn't put in this state */
  1044. if (!WARN_ON(!teedev->desc)) {
  1045. teedev->num_users--;
  1046. if (!teedev->num_users) {
  1047. teedev->desc = NULL;
  1048. complete(&teedev->c_no_users);
  1049. }
  1050. }
  1051. mutex_unlock(&teedev->mutex);
  1052. }
  1053. EXPORT_SYMBOL_GPL(tee_device_put);
  1054. bool tee_device_get(struct tee_device *teedev)
  1055. {
  1056. mutex_lock(&teedev->mutex);
  1057. if (!teedev->desc) {
  1058. mutex_unlock(&teedev->mutex);
  1059. return false;
  1060. }
  1061. teedev->num_users++;
  1062. mutex_unlock(&teedev->mutex);
  1063. return true;
  1064. }
  1065. EXPORT_SYMBOL_GPL(tee_device_get);
  1066. /**
  1067. * tee_device_unregister() - Removes a TEE device
  1068. * @teedev: Device to unregister
  1069. *
  1070. * This function should be called to remove the @teedev even if
  1071. * tee_device_register() hasn't been called yet. Does nothing if
  1072. * @teedev is NULL.
  1073. */
  1074. void tee_device_unregister(struct tee_device *teedev)
  1075. {
  1076. if (!teedev)
  1077. return;
  1078. tee_device_put_all_dma_heaps(teedev);
  1079. if (teedev->flags & TEE_DEVICE_FLAG_REGISTERED)
  1080. cdev_device_del(&teedev->cdev, &teedev->dev);
  1081. tee_device_put(teedev);
  1082. wait_for_completion(&teedev->c_no_users);
  1083. /*
  1084. * No need to take a mutex any longer now since teedev->desc was
  1085. * set to NULL before teedev->c_no_users was completed.
  1086. */
  1087. teedev->pool = NULL;
  1088. put_device(&teedev->dev);
  1089. }
  1090. EXPORT_SYMBOL_GPL(tee_device_unregister);
  1091. /**
  1092. * tee_get_drvdata() - Return driver_data pointer
  1093. * @teedev: Device containing the driver_data pointer
  1094. * @returns the driver_data pointer supplied to tee_device_alloc().
  1095. */
  1096. void *tee_get_drvdata(struct tee_device *teedev)
  1097. {
  1098. return dev_get_drvdata(&teedev->dev);
  1099. }
  1100. EXPORT_SYMBOL_GPL(tee_get_drvdata);
  1101. struct match_dev_data {
  1102. struct tee_ioctl_version_data *vers;
  1103. const void *data;
  1104. int (*match)(struct tee_ioctl_version_data *, const void *);
  1105. };
  1106. static int match_dev(struct device *dev, const void *data)
  1107. {
  1108. const struct match_dev_data *match_data = data;
  1109. struct tee_device *teedev = container_of(dev, struct tee_device, dev);
  1110. teedev->desc->ops->get_version(teedev, match_data->vers);
  1111. return match_data->match(match_data->vers, match_data->data);
  1112. }
  1113. struct tee_context *
  1114. tee_client_open_context(struct tee_context *start,
  1115. int (*match)(struct tee_ioctl_version_data *,
  1116. const void *),
  1117. const void *data, struct tee_ioctl_version_data *vers)
  1118. {
  1119. struct device *dev = NULL;
  1120. struct device *put_dev = NULL;
  1121. struct tee_context *ctx = NULL;
  1122. struct tee_ioctl_version_data v;
  1123. struct match_dev_data match_data = { vers ? vers : &v, data, match };
  1124. if (start)
  1125. dev = &start->teedev->dev;
  1126. do {
  1127. dev = class_find_device(&tee_class, dev, &match_data, match_dev);
  1128. if (!dev) {
  1129. ctx = ERR_PTR(-ENOENT);
  1130. break;
  1131. }
  1132. put_device(put_dev);
  1133. put_dev = dev;
  1134. ctx = teedev_open(container_of(dev, struct tee_device, dev));
  1135. } while (IS_ERR(ctx) && PTR_ERR(ctx) != -ENOMEM);
  1136. put_device(put_dev);
  1137. /*
  1138. * Default behaviour for in kernel client is to not wait for
  1139. * tee-supplicant if not present for any requests in this context.
  1140. * Also this flag could be configured again before call to
  1141. * tee_client_open_session() if any in kernel client requires
  1142. * different behaviour.
  1143. */
  1144. if (!IS_ERR(ctx))
  1145. ctx->supp_nowait = true;
  1146. return ctx;
  1147. }
  1148. EXPORT_SYMBOL_GPL(tee_client_open_context);
  1149. void tee_client_close_context(struct tee_context *ctx)
  1150. {
  1151. teedev_close_context(ctx);
  1152. }
  1153. EXPORT_SYMBOL_GPL(tee_client_close_context);
  1154. void tee_client_get_version(struct tee_context *ctx,
  1155. struct tee_ioctl_version_data *vers)
  1156. {
  1157. ctx->teedev->desc->ops->get_version(ctx->teedev, vers);
  1158. }
  1159. EXPORT_SYMBOL_GPL(tee_client_get_version);
  1160. int tee_client_open_session(struct tee_context *ctx,
  1161. struct tee_ioctl_open_session_arg *arg,
  1162. struct tee_param *param)
  1163. {
  1164. if (!ctx->teedev->desc->ops->open_session)
  1165. return -EINVAL;
  1166. return ctx->teedev->desc->ops->open_session(ctx, arg, param);
  1167. }
  1168. EXPORT_SYMBOL_GPL(tee_client_open_session);
  1169. int tee_client_close_session(struct tee_context *ctx, u32 session)
  1170. {
  1171. if (!ctx->teedev->desc->ops->close_session)
  1172. return -EINVAL;
  1173. return ctx->teedev->desc->ops->close_session(ctx, session);
  1174. }
  1175. EXPORT_SYMBOL_GPL(tee_client_close_session);
  1176. int tee_client_system_session(struct tee_context *ctx, u32 session)
  1177. {
  1178. if (!ctx->teedev->desc->ops->system_session)
  1179. return -EINVAL;
  1180. return ctx->teedev->desc->ops->system_session(ctx, session);
  1181. }
  1182. EXPORT_SYMBOL_GPL(tee_client_system_session);
  1183. int tee_client_invoke_func(struct tee_context *ctx,
  1184. struct tee_ioctl_invoke_arg *arg,
  1185. struct tee_param *param)
  1186. {
  1187. if (!ctx->teedev->desc->ops->invoke_func)
  1188. return -EINVAL;
  1189. return ctx->teedev->desc->ops->invoke_func(ctx, arg, param);
  1190. }
  1191. EXPORT_SYMBOL_GPL(tee_client_invoke_func);
  1192. int tee_client_cancel_req(struct tee_context *ctx,
  1193. struct tee_ioctl_cancel_arg *arg)
  1194. {
  1195. if (!ctx->teedev->desc->ops->cancel_req)
  1196. return -EINVAL;
  1197. return ctx->teedev->desc->ops->cancel_req(ctx, arg->cancel_id,
  1198. arg->session);
  1199. }
  1200. static int tee_client_device_match(struct device *dev,
  1201. const struct device_driver *drv)
  1202. {
  1203. const struct tee_client_device_id *id_table;
  1204. struct tee_client_device *tee_device;
  1205. id_table = to_tee_client_driver(drv)->id_table;
  1206. tee_device = to_tee_client_device(dev);
  1207. while (!uuid_is_null(&id_table->uuid)) {
  1208. if (uuid_equal(&tee_device->id.uuid, &id_table->uuid))
  1209. return 1;
  1210. id_table++;
  1211. }
  1212. return 0;
  1213. }
  1214. static int tee_client_device_uevent(const struct device *dev,
  1215. struct kobj_uevent_env *env)
  1216. {
  1217. uuid_t *dev_id = &to_tee_client_device(dev)->id.uuid;
  1218. return add_uevent_var(env, "MODALIAS=tee:%pUb", dev_id);
  1219. }
  1220. static int tee_client_device_probe(struct device *dev)
  1221. {
  1222. struct tee_client_device *tcdev = to_tee_client_device(dev);
  1223. struct tee_client_driver *drv = to_tee_client_driver(dev->driver);
  1224. if (drv->probe)
  1225. return drv->probe(tcdev);
  1226. else
  1227. return 0;
  1228. }
  1229. static void tee_client_device_remove(struct device *dev)
  1230. {
  1231. struct tee_client_device *tcdev = to_tee_client_device(dev);
  1232. struct tee_client_driver *drv = to_tee_client_driver(dev->driver);
  1233. if (drv->remove)
  1234. drv->remove(tcdev);
  1235. }
  1236. static void tee_client_device_shutdown(struct device *dev)
  1237. {
  1238. struct tee_client_device *tcdev = to_tee_client_device(dev);
  1239. struct tee_client_driver *drv = to_tee_client_driver(dev->driver);
  1240. if (dev->driver && drv->shutdown)
  1241. drv->shutdown(tcdev);
  1242. }
  1243. const struct bus_type tee_bus_type = {
  1244. .name = "tee",
  1245. .match = tee_client_device_match,
  1246. .uevent = tee_client_device_uevent,
  1247. .probe = tee_client_device_probe,
  1248. .remove = tee_client_device_remove,
  1249. .shutdown = tee_client_device_shutdown,
  1250. };
  1251. EXPORT_SYMBOL_GPL(tee_bus_type);
  1252. static int tee_client_device_probe_legacy(struct tee_client_device *tcdev)
  1253. {
  1254. struct device *dev = &tcdev->dev;
  1255. struct device_driver *driver = dev->driver;
  1256. return driver->probe(dev);
  1257. }
  1258. static void tee_client_device_remove_legacy(struct tee_client_device *tcdev)
  1259. {
  1260. struct device *dev = &tcdev->dev;
  1261. struct device_driver *driver = dev->driver;
  1262. driver->remove(dev);
  1263. }
  1264. static void tee_client_device_shutdown_legacy(struct tee_client_device *tcdev)
  1265. {
  1266. struct device *dev = &tcdev->dev;
  1267. struct device_driver *driver = dev->driver;
  1268. driver->shutdown(dev);
  1269. }
  1270. int __tee_client_driver_register(struct tee_client_driver *tee_driver,
  1271. struct module *owner)
  1272. {
  1273. tee_driver->driver.owner = owner;
  1274. tee_driver->driver.bus = &tee_bus_type;
  1275. /*
  1276. * Drivers that have callbacks set for tee_driver->driver need updating
  1277. * to use the callbacks in tee_driver instead. driver_register() warns
  1278. * about that, so no need to warn here, too.
  1279. */
  1280. if (!tee_driver->probe && tee_driver->driver.probe)
  1281. tee_driver->probe = tee_client_device_probe_legacy;
  1282. if (!tee_driver->remove && tee_driver->driver.remove)
  1283. tee_driver->remove = tee_client_device_remove_legacy;
  1284. if (!tee_driver->shutdown && tee_driver->driver.probe)
  1285. tee_driver->shutdown = tee_client_device_shutdown_legacy;
  1286. return driver_register(&tee_driver->driver);
  1287. }
  1288. EXPORT_SYMBOL_GPL(__tee_client_driver_register);
  1289. void tee_client_driver_unregister(struct tee_client_driver *tee_driver)
  1290. {
  1291. driver_unregister(&tee_driver->driver);
  1292. }
  1293. EXPORT_SYMBOL_GPL(tee_client_driver_unregister);
  1294. static int __init tee_init(void)
  1295. {
  1296. int rc;
  1297. rc = class_register(&tee_class);
  1298. if (rc) {
  1299. pr_err("couldn't create class\n");
  1300. return rc;
  1301. }
  1302. rc = alloc_chrdev_region(&tee_devt, 0, TEE_NUM_DEVICES, "tee");
  1303. if (rc) {
  1304. pr_err("failed to allocate char dev region\n");
  1305. goto out_unreg_class;
  1306. }
  1307. rc = bus_register(&tee_bus_type);
  1308. if (rc) {
  1309. pr_err("failed to register tee bus\n");
  1310. goto out_unreg_chrdev;
  1311. }
  1312. return 0;
  1313. out_unreg_chrdev:
  1314. unregister_chrdev_region(tee_devt, TEE_NUM_DEVICES);
  1315. out_unreg_class:
  1316. class_unregister(&tee_class);
  1317. return rc;
  1318. }
  1319. static void __exit tee_exit(void)
  1320. {
  1321. bus_unregister(&tee_bus_type);
  1322. unregister_chrdev_region(tee_devt, TEE_NUM_DEVICES);
  1323. class_unregister(&tee_class);
  1324. }
  1325. subsys_initcall(tee_init);
  1326. module_exit(tee_exit);
  1327. MODULE_AUTHOR("Linaro");
  1328. MODULE_DESCRIPTION("TEE Driver");
  1329. MODULE_VERSION("1.0");
  1330. MODULE_LICENSE("GPL v2");
  1331. MODULE_IMPORT_NS("DMA_BUF");
  1332. MODULE_IMPORT_NS("DMA_BUF_HEAP");