1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * drivers/media/platform/samsung/s5p-mfc/s5p_mfc_opr.c
4  *
5  * Samsung MFC (Multi Function Codec - FIMV) driver
6  * This file contains hw related functions.
7  *
8  * Kamil Debski, Copyright (c) 2012 Samsung Electronics Co., Ltd.
9  * http://www.samsung.com/
10  */
11 
12 #include "s5p_mfc_debug.h"
13 #include "s5p_mfc_opr.h"
14 #include "s5p_mfc_opr_v5.h"
15 #include "s5p_mfc_opr_v6.h"
16 
17 static struct s5p_mfc_hw_ops *s5p_mfc_ops;
18 
s5p_mfc_init_hw_ops(struct s5p_mfc_dev * dev)19 void s5p_mfc_init_hw_ops(struct s5p_mfc_dev *dev)
20 {
21 	if (IS_MFCV6_PLUS(dev)) {
22 		s5p_mfc_ops = s5p_mfc_init_hw_ops_v6();
23 		dev->warn_start = S5P_FIMV_ERR_WARNINGS_START_V6;
24 	} else {
25 		s5p_mfc_ops = s5p_mfc_init_hw_ops_v5();
26 		dev->warn_start = S5P_FIMV_ERR_WARNINGS_START;
27 	}
28 	dev->mfc_ops = s5p_mfc_ops;
29 }
30 
s5p_mfc_init_regs(struct s5p_mfc_dev * dev)31 void s5p_mfc_init_regs(struct s5p_mfc_dev *dev)
32 {
33 	if (IS_MFCV6_PLUS(dev))
34 		dev->mfc_regs = s5p_mfc_init_regs_v6_plus(dev);
35 }
36 
s5p_mfc_alloc_priv_buf(struct s5p_mfc_dev * dev,unsigned int mem_ctx,struct s5p_mfc_priv_buf * b)37 int s5p_mfc_alloc_priv_buf(struct s5p_mfc_dev *dev, unsigned int mem_ctx,
38 			   struct s5p_mfc_priv_buf *b)
39 {
40 	unsigned int bits = dev->mem_size >> PAGE_SHIFT;
41 	unsigned int count = b->size >> PAGE_SHIFT;
42 	unsigned int align = (SZ_64K >> PAGE_SHIFT) - 1;
43 	unsigned int start, offset;
44 
45 	mfc_debug(3, "Allocating priv: %zu\n", b->size);
46 
47 	if (dev->mem_virt) {
48 		start = bitmap_find_next_zero_area(dev->mem_bitmap, bits, 0, count, align);
49 		if (start > bits)
50 			goto no_mem;
51 
52 		bitmap_set(dev->mem_bitmap, start, count);
53 		offset = start << PAGE_SHIFT;
54 		b->virt = dev->mem_virt + offset;
55 		b->dma = dev->mem_base + offset;
56 	} else {
57 		struct device *mem_dev = dev->mem_dev[mem_ctx];
58 		dma_addr_t base = dev->dma_base[mem_ctx];
59 
60 		b->ctx = mem_ctx;
61 		b->virt = dma_alloc_coherent(mem_dev, b->size, &b->dma, GFP_KERNEL);
62 		if (!b->virt)
63 			goto no_mem;
64 		if (b->dma < base) {
65 			mfc_err("Invalid memory configuration - buffer (%pad) is below base memory address(%pad)\n",
66 				&b->dma, &base);
67 			dma_free_coherent(mem_dev, b->size, b->virt, b->dma);
68 			return -ENOMEM;
69 		}
70 	}
71 
72 	mfc_debug(3, "Allocated addr %p %pad\n", b->virt, &b->dma);
73 	return 0;
74 no_mem:
75 	mfc_err("Allocating private buffer of size %zu failed\n", b->size);
76 	return -ENOMEM;
77 }
78 
s5p_mfc_alloc_generic_buf(struct s5p_mfc_dev * dev,unsigned int mem_ctx,struct s5p_mfc_priv_buf * b)79 int s5p_mfc_alloc_generic_buf(struct s5p_mfc_dev *dev, unsigned int mem_ctx,
80 			   struct s5p_mfc_priv_buf *b)
81 {
82 	struct device *mem_dev = dev->mem_dev[mem_ctx];
83 
84 	mfc_debug(3, "Allocating generic buf: %zu\n", b->size);
85 
86 	b->ctx = mem_ctx;
87 	b->virt = dma_alloc_coherent(mem_dev, b->size, &b->dma, GFP_KERNEL);
88 	if (!b->virt)
89 		goto no_mem;
90 
91 	mfc_debug(3, "Allocated addr %p %pad\n", b->virt, &b->dma);
92 	return 0;
93 no_mem:
94 	mfc_err("Allocating generic buffer of size %zu failed\n", b->size);
95 	return -ENOMEM;
96 }
97 
s5p_mfc_release_priv_buf(struct s5p_mfc_dev * dev,struct s5p_mfc_priv_buf * b)98 void s5p_mfc_release_priv_buf(struct s5p_mfc_dev *dev,
99 			      struct s5p_mfc_priv_buf *b)
100 {
101 	if (dev->mem_virt) {
102 		unsigned int start = (b->dma - dev->mem_base) >> PAGE_SHIFT;
103 		unsigned int count = b->size >> PAGE_SHIFT;
104 
105 		bitmap_clear(dev->mem_bitmap, start, count);
106 	} else {
107 		struct device *mem_dev = dev->mem_dev[b->ctx];
108 
109 		dma_free_coherent(mem_dev, b->size, b->virt, b->dma);
110 	}
111 	b->virt = NULL;
112 	b->dma = 0;
113 	b->size = 0;
114 }
115 
s5p_mfc_release_generic_buf(struct s5p_mfc_dev * dev,struct s5p_mfc_priv_buf * b)116 void s5p_mfc_release_generic_buf(struct s5p_mfc_dev *dev,
117 			      struct s5p_mfc_priv_buf *b)
118 {
119 	struct device *mem_dev = dev->mem_dev[b->ctx];
120 	dma_free_coherent(mem_dev, b->size, b->virt, b->dma);
121 	b->virt = NULL;
122 	b->dma = 0;
123 	b->size = 0;
124 }
125