| 1 | |
| 2 |
|
| 3 |
|
| 4 | #include <drm/drm_drv.h>
|
| 5 | #include <linux/array_size.h>
|
| 6 | #include <linux/clk.h>
|
| 7 | #include <linux/dma-mapping.h>
|
| 8 | #include <linux/platform_device.h>
|
| 9 | #include <linux/of.h>
|
| 10 |
|
| 11 | #include "rocket_device.h"
|
| 12 |
|
| 13 | struct rocket_device *rocket_device_init(struct platform_device *pdev,
|
| 14 | const struct drm_driver *rocket_drm_driver)
|
| 15 | {
|
| 16 | struct device *dev = &pdev->dev;
|
| 17 | struct device_node *core_node;
|
| 18 | struct rocket_device *rdev;
|
| 19 | struct drm_device *ddev;
|
| 20 | unsigned int num_cores = 0;
|
| 21 | int err;
|
| 22 |
|
| 23 | rdev = devm_drm_dev_alloc(dev, rocket_drm_driver, struct rocket_device, ddev);
|
| 24 | if (IS_ERR(rdev))
|
| 25 | return rdev;
|
| 26 |
|
| 27 | ddev = &rdev->ddev;
|
| 28 | dev_set_drvdata(dev, rdev);
|
| 29 |
|
| 30 | for_each_compatible_node(core_node, NULL, "rockchip,rk3588-rknn-core")
|
| 31 | if (of_device_is_available(core_node))
|
| 32 | num_cores++;
|
| 33 |
|
| 34 | rdev->max_cores = num_cores;
|
| 35 |
|
| 36 | rdev->cores = devm_kcalloc(dev, num_cores, sizeof(*rdev->cores), GFP_KERNEL);
|
| 37 | if (!rdev->cores)
|
| 38 | return ERR_PTR(-ENOMEM);
|
| 39 |
|
| 40 | dma_set_max_seg_size(dev, UINT_MAX);
|
| 41 |
|
| 42 | err = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(40));
|
| 43 | if (err)
|
| 44 | return ERR_PTR(err);
|
| 45 |
|
| 46 | err = devm_mutex_init(dev, &rdev->sched_lock);
|
| 47 | if (err)
|
| 48 | return ERR_PTR(-ENOMEM);
|
| 49 |
|
| 50 | err = drm_dev_register(ddev, 0);
|
| 51 | if (err)
|
| 52 | return ERR_PTR(err);
|
| 53 |
|
| 54 | return rdev;
|
| 55 | }
|
| 56 |
|
| 57 | void rocket_device_fini(struct rocket_device *rdev)
|
| 58 | {
|
| 59 | WARN_ON(rdev->num_cores > 0);
|
| 60 |
|
| 61 | drm_dev_unregister(&rdev->ddev);
|
| 62 | }
|