Lines Matching +full:src +full:-
1 // SPDX-License-Identifier: GPL-2.0-only
24 static int src_default_config_memrd(struct src *src);
25 static int src_default_config_memwr(struct src *src);
26 static int src_default_config_arcrw(struct src *src);
28 static int (*src_default_config[3])(struct src *) = {
34 static int src_set_state(struct src *src, unsigned int state)
38 hw = src->rsc.hw;
39 hw->src_set_state(src->rsc.ctrl_blk, state);
44 static int src_set_bm(struct src *src, unsigned int bm)
48 hw = src->rsc.hw;
49 hw->src_set_bm(src->rsc.ctrl_blk, bm);
54 static int src_set_sf(struct src *src, unsigned int sf)
58 hw = src->rsc.hw;
59 hw->src_set_sf(src->rsc.ctrl_blk, sf);
64 static int src_set_pm(struct src *src, unsigned int pm)
68 hw = src->rsc.hw;
69 hw->src_set_pm(src->rsc.ctrl_blk, pm);
74 static int src_set_rom(struct src *src, unsigned int rom)
78 hw = src->rsc.hw;
79 hw->src_set_rom(src->rsc.ctrl_blk, rom);
84 static int src_set_vo(struct src *src, unsigned int vo)
88 hw = src->rsc.hw;
89 hw->src_set_vo(src->rsc.ctrl_blk, vo);
94 static int src_set_st(struct src *src, unsigned int st)
98 hw = src->rsc.hw;
99 hw->src_set_st(src->rsc.ctrl_blk, st);
104 static int src_set_bp(struct src *src, unsigned int bp)
108 hw = src->rsc.hw;
109 hw->src_set_bp(src->rsc.ctrl_blk, bp);
114 static int src_set_cisz(struct src *src, unsigned int cisz)
118 hw = src->rsc.hw;
119 hw->src_set_cisz(src->rsc.ctrl_blk, cisz);
124 static int src_set_ca(struct src *src, unsigned int ca)
128 hw = src->rsc.hw;
129 hw->src_set_ca(src->rsc.ctrl_blk, ca);
134 static int src_set_sa(struct src *src, unsigned int sa)
138 hw = src->rsc.hw;
139 hw->src_set_sa(src->rsc.ctrl_blk, sa);
144 static int src_set_la(struct src *src, unsigned int la)
148 hw = src->rsc.hw;
149 hw->src_set_la(src->rsc.ctrl_blk, la);
154 static int src_set_pitch(struct src *src, unsigned int pitch)
158 hw = src->rsc.hw;
159 hw->src_set_pitch(src->rsc.ctrl_blk, pitch);
164 static int src_set_clear_zbufs(struct src *src)
168 hw = src->rsc.hw;
169 hw->src_set_clear_zbufs(src->rsc.ctrl_blk, 1);
174 static int src_commit_write(struct src *src)
180 hw = src->rsc.hw;
181 src->rsc.ops->master(&src->rsc);
182 if (src->rsc.msr > 1) {
184 dirty = hw->src_get_dirty(src->rsc.ctrl_blk) & conj_mask;
186 hw->src_commit_write(hw, src->rsc.ops->index(&src->rsc),
187 src->rsc.ctrl_blk);
190 if (MEMWR == src->mode)
193 for (i = 1; i < src->rsc.msr; i++) {
194 src->rsc.ops->next_conj(&src->rsc);
195 hw->src_set_dirty(src->rsc.ctrl_blk, dirty);
196 hw->src_commit_write(hw, src->rsc.ops->index(&src->rsc),
197 src->rsc.ctrl_blk);
199 src->rsc.ops->master(&src->rsc);
204 static int src_get_ca(struct src *src)
208 hw = src->rsc.hw;
209 return hw->src_get_ca(hw, src->rsc.ops->index(&src->rsc),
210 src->rsc.ctrl_blk);
213 static int src_init(struct src *src)
215 src_default_config[src->mode](src);
220 static struct src *src_next_interleave(struct src *src)
222 return src->intlv;
225 static int src_default_config_memrd(struct src *src)
227 struct hw *hw = src->rsc.hw;
230 hw->src_set_state(src->rsc.ctrl_blk, SRC_STATE_OFF);
231 hw->src_set_bm(src->rsc.ctrl_blk, 1);
232 for (rsr = 0, msr = src->rsc.msr; msr > 1; msr >>= 1)
235 hw->src_set_rsr(src->rsc.ctrl_blk, rsr);
236 hw->src_set_sf(src->rsc.ctrl_blk, SRC_SF_S16);
237 hw->src_set_wr(src->rsc.ctrl_blk, 0);
238 hw->src_set_pm(src->rsc.ctrl_blk, 0);
239 hw->src_set_rom(src->rsc.ctrl_blk, 0);
240 hw->src_set_vo(src->rsc.ctrl_blk, 0);
241 hw->src_set_st(src->rsc.ctrl_blk, 0);
242 hw->src_set_ilsz(src->rsc.ctrl_blk, src->multi - 1);
243 hw->src_set_cisz(src->rsc.ctrl_blk, 0x80);
244 hw->src_set_sa(src->rsc.ctrl_blk, 0x0);
245 hw->src_set_la(src->rsc.ctrl_blk, 0x1000);
246 hw->src_set_ca(src->rsc.ctrl_blk, 0x80);
247 hw->src_set_pitch(src->rsc.ctrl_blk, 0x1000000);
248 hw->src_set_clear_zbufs(src->rsc.ctrl_blk, 1);
250 src->rsc.ops->master(&src->rsc);
251 hw->src_commit_write(hw, src->rsc.ops->index(&src->rsc),
252 src->rsc.ctrl_blk);
254 for (msr = 1; msr < src->rsc.msr; msr++) {
255 src->rsc.ops->next_conj(&src->rsc);
256 hw->src_set_pitch(src->rsc.ctrl_blk, 0x1000000);
257 hw->src_commit_write(hw, src->rsc.ops->index(&src->rsc),
258 src->rsc.ctrl_blk);
260 src->rsc.ops->master(&src->rsc);
265 static int src_default_config_memwr(struct src *src)
267 struct hw *hw = src->rsc.hw;
269 hw->src_set_state(src->rsc.ctrl_blk, SRC_STATE_OFF);
270 hw->src_set_bm(src->rsc.ctrl_blk, 1);
271 hw->src_set_rsr(src->rsc.ctrl_blk, 0);
272 hw->src_set_sf(src->rsc.ctrl_blk, SRC_SF_S16);
273 hw->src_set_wr(src->rsc.ctrl_blk, 1);
274 hw->src_set_pm(src->rsc.ctrl_blk, 0);
275 hw->src_set_rom(src->rsc.ctrl_blk, 0);
276 hw->src_set_vo(src->rsc.ctrl_blk, 0);
277 hw->src_set_st(src->rsc.ctrl_blk, 0);
278 hw->src_set_ilsz(src->rsc.ctrl_blk, 0);
279 hw->src_set_cisz(src->rsc.ctrl_blk, 0x80);
280 hw->src_set_sa(src->rsc.ctrl_blk, 0x0);
281 hw->src_set_la(src->rsc.ctrl_blk, 0x1000);
282 hw->src_set_ca(src->rsc.ctrl_blk, 0x80);
283 hw->src_set_pitch(src->rsc.ctrl_blk, 0x1000000);
284 hw->src_set_clear_zbufs(src->rsc.ctrl_blk, 1);
286 src->rsc.ops->master(&src->rsc);
287 hw->src_commit_write(hw, src->rsc.ops->index(&src->rsc),
288 src->rsc.ctrl_blk);
293 static int src_default_config_arcrw(struct src *src)
295 struct hw *hw = src->rsc.hw;
299 hw->src_set_state(src->rsc.ctrl_blk, SRC_STATE_OFF);
300 hw->src_set_bm(src->rsc.ctrl_blk, 0);
301 for (rsr = 0, msr = src->rsc.msr; msr > 1; msr >>= 1)
304 hw->src_set_rsr(src->rsc.ctrl_blk, rsr);
305 hw->src_set_sf(src->rsc.ctrl_blk, SRC_SF_F32);
306 hw->src_set_wr(src->rsc.ctrl_blk, 0);
307 hw->src_set_pm(src->rsc.ctrl_blk, 0);
308 hw->src_set_rom(src->rsc.ctrl_blk, 0);
309 hw->src_set_vo(src->rsc.ctrl_blk, 0);
310 hw->src_set_st(src->rsc.ctrl_blk, 0);
311 hw->src_set_ilsz(src->rsc.ctrl_blk, 0);
312 hw->src_set_cisz(src->rsc.ctrl_blk, 0x80);
313 hw->src_set_sa(src->rsc.ctrl_blk, 0x0);
314 /*hw->src_set_sa(src->rsc.ctrl_blk, 0x100);*/
315 hw->src_set_la(src->rsc.ctrl_blk, 0x1000);
316 /*hw->src_set_la(src->rsc.ctrl_blk, 0x03ffffe0);*/
317 hw->src_set_ca(src->rsc.ctrl_blk, 0x80);
318 hw->src_set_pitch(src->rsc.ctrl_blk, 0x1000000);
319 hw->src_set_clear_zbufs(src->rsc.ctrl_blk, 1);
321 dirty = hw->src_get_dirty(src->rsc.ctrl_blk);
322 src->rsc.ops->master(&src->rsc);
323 for (msr = 0; msr < src->rsc.msr; msr++) {
324 hw->src_set_dirty(src->rsc.ctrl_blk, dirty);
325 hw->src_commit_write(hw, src->rsc.ops->index(&src->rsc),
326 src->rsc.ctrl_blk);
327 src->rsc.ops->next_conj(&src->rsc);
329 src->rsc.ops->master(&src->rsc);
356 src_rsc_init(struct src *src, u32 idx,
361 struct src *p;
363 n = (MEMRD == desc->mode) ? desc->multi : 1;
364 for (i = 0, p = src; i < n; i++, p++) {
365 err = rsc_init(&p->rsc, idx + i, SRC, desc->msr, mgr->mgr.hw);
369 /* Initialize src specific rsc operations */
370 p->ops = &src_rsc_ops;
371 p->multi = (0 == i) ? desc->multi : 1;
372 p->mode = desc->mode;
373 src_default_config[desc->mode](p);
374 mgr->src_enable(mgr, p);
375 p->intlv = p + 1;
377 (--p)->intlv = NULL; /* Set @intlv of the last SRC to NULL */
379 mgr->commit_write(mgr);
384 for (i--, p--; i >= 0; i--, p--) {
385 mgr->src_disable(mgr, p);
386 rsc_uninit(&p->rsc);
388 mgr->commit_write(mgr);
392 static int src_rsc_uninit(struct src *src, struct src_mgr *mgr)
395 struct src *p;
397 n = (MEMRD == src->mode) ? src->multi : 1;
398 for (i = 0, p = src; i < n; i++, p++) {
399 mgr->src_disable(mgr, p);
400 rsc_uninit(&p->rsc);
401 p->multi = 0;
402 p->ops = NULL;
403 p->mode = NUM_SRCMODES;
404 p->intlv = NULL;
406 mgr->commit_write(mgr);
412 get_src_rsc(struct src_mgr *mgr, const struct src_desc *desc, struct src **rsrc)
416 struct src *src;
420 /* Check whether there are sufficient src resources to meet request. */
421 scoped_guard(spinlock_irqsave, &mgr->mgr_lock) {
422 if (MEMRD == desc->mode)
423 err = mgr_get_resource(&mgr->mgr, desc->multi, &idx);
425 err = mgr_get_resource(&mgr->mgr, 1, &idx);
428 dev_err(mgr->card->dev,
429 "Can't meet SRC resource request!\n");
433 /* Allocate mem for master src resource */
434 if (MEMRD == desc->mode)
435 src = kcalloc(desc->multi, sizeof(*src), GFP_KERNEL);
437 src = kzalloc(sizeof(*src), GFP_KERNEL);
439 if (!src) {
440 err = -ENOMEM;
444 err = src_rsc_init(src, idx, desc, mgr);
448 *rsrc = src;
453 kfree(src);
455 scoped_guard(spinlock_irqsave, &mgr->mgr_lock) {
456 if (MEMRD == desc->mode)
457 mgr_put_resource(&mgr->mgr, desc->multi, idx);
459 mgr_put_resource(&mgr->mgr, 1, idx);
464 static int put_src_rsc(struct src_mgr *mgr, struct src *src)
466 scoped_guard(spinlock_irqsave, &mgr->mgr_lock) {
467 src->rsc.ops->master(&src->rsc);
468 if (MEMRD == src->mode)
469 mgr_put_resource(&mgr->mgr, src->multi,
470 src->rsc.ops->index(&src->rsc));
472 mgr_put_resource(&mgr->mgr, 1, src->rsc.ops->index(&src->rsc));
474 src_rsc_uninit(src, mgr);
475 kfree(src);
480 static int src_enable_s(struct src_mgr *mgr, struct src *src)
482 struct hw *hw = mgr->mgr.hw;
485 src->rsc.ops->master(&src->rsc);
486 for (i = 0; i < src->rsc.msr; i++) {
487 hw->src_mgr_enbs_src(mgr->mgr.ctrl_blk,
488 src->rsc.ops->index(&src->rsc));
489 src->rsc.ops->next_conj(&src->rsc);
491 src->rsc.ops->master(&src->rsc);
496 static int src_enable(struct src_mgr *mgr, struct src *src)
498 struct hw *hw = mgr->mgr.hw;
501 src->rsc.ops->master(&src->rsc);
502 for (i = 0; i < src->rsc.msr; i++) {
503 hw->src_mgr_enb_src(mgr->mgr.ctrl_blk,
504 src->rsc.ops->index(&src->rsc));
505 src->rsc.ops->next_conj(&src->rsc);
507 src->rsc.ops->master(&src->rsc);
512 static int src_disable(struct src_mgr *mgr, struct src *src)
514 struct hw *hw = mgr->mgr.hw;
517 src->rsc.ops->master(&src->rsc);
518 for (i = 0; i < src->rsc.msr; i++) {
519 hw->src_mgr_dsb_src(mgr->mgr.ctrl_blk,
520 src->rsc.ops->index(&src->rsc));
521 src->rsc.ops->next_conj(&src->rsc);
523 src->rsc.ops->master(&src->rsc);
530 struct hw *hw = mgr->mgr.hw;
532 hw->src_mgr_commit_write(hw, mgr->mgr.ctrl_blk);
545 return -ENOMEM;
547 err = rsc_mgr_init(&src_mgr->mgr, SRC, SRC_RESOURCE_NUM, hw);
551 spin_lock_init(&src_mgr->mgr_lock);
552 conj_mask = hw->src_dirty_conj_mask();
554 src_mgr->get_src = get_src_rsc;
555 src_mgr->put_src = put_src_rsc;
556 src_mgr->src_enable_s = src_enable_s;
557 src_mgr->src_enable = src_enable;
558 src_mgr->src_disable = src_disable;
559 src_mgr->commit_write = src_mgr_commit_write;
560 src_mgr->card = hw->card;
562 /* Disable all SRC resources. */
564 hw->src_mgr_dsb_src(src_mgr->mgr.ctrl_blk, i);
566 hw->src_mgr_commit_write(hw, src_mgr->mgr.ctrl_blk);
580 rsc_mgr_uninit(&src_mgr->mgr);
590 rsc->conj = 0;
591 rsc->idx = container_of(rsc, struct srcimp, rsc)->idx[0];
596 rsc->conj++;
601 return container_of(rsc, struct srcimp, rsc)->idx[rsc->conj];
611 static int srcimp_map(struct srcimp *srcimp, struct src *src, struct rsc *input)
616 srcimp->rsc.ops->master(&srcimp->rsc);
617 src->rsc.ops->master(&src->rsc);
618 input->ops->master(input);
621 for (i = 0; i < srcimp->rsc.msr; i++) {
622 entry = &srcimp->imappers[i];
623 entry->slot = input->ops->output_slot(input);
624 entry->user = src->rsc.ops->index(&src->rsc);
625 entry->addr = srcimp->rsc.ops->index(&srcimp->rsc);
626 srcimp->mgr->imap_add(srcimp->mgr, entry);
627 srcimp->mapped |= (0x1 << i);
629 srcimp->rsc.ops->next_conj(&srcimp->rsc);
630 input->ops->next_conj(input);
633 srcimp->rsc.ops->master(&srcimp->rsc);
634 input->ops->master(input);
644 for (i = 0; i < srcimp->rsc.msr; i++) {
645 if (srcimp->mapped & (0x1 << i)) {
646 srcimp->mgr->imap_delete(srcimp->mgr,
647 &srcimp->imappers[i]);
648 srcimp->mapped &= ~(0x1 << i);
666 err = rsc_init(&srcimp->rsc, srcimp->idx[0],
667 SRCIMP, desc->msr, mgr->mgr.hw);
672 srcimp->imappers = kcalloc(desc->msr, sizeof(struct imapper),
674 if (!srcimp->imappers) {
675 err = -ENOMEM;
680 srcimp->rsc.ops = &srcimp_basic_rsc_ops;
681 srcimp->ops = &srcimp_ops;
682 srcimp->mgr = mgr;
684 srcimp->rsc.ops->master(&srcimp->rsc);
689 rsc_uninit(&srcimp->rsc);
695 kfree(srcimp->imappers);
696 srcimp->imappers = NULL;
697 srcimp->ops = NULL;
698 srcimp->mgr = NULL;
699 rsc_uninit(&srcimp->rsc);
717 return -ENOMEM;
721 scoped_guard(spinlock_irqsave, &mgr->mgr_lock) {
722 for (i = 0; i < desc->msr; i++) {
723 err = mgr_get_resource(&mgr->mgr, 1, &idx);
727 srcimp->idx[i] = idx;
731 dev_err(mgr->card->dev,
745 scoped_guard(spinlock_irqsave, &mgr->mgr_lock) {
746 for (i--; i >= 0; i--)
747 mgr_put_resource(&mgr->mgr, 1, srcimp->idx[i]);
757 scoped_guard(spinlock_irqsave, &mgr->mgr_lock) {
758 for (i = 0; i < srcimp->rsc.msr; i++)
759 mgr_put_resource(&mgr->mgr, 1, srcimp->idx[i]);
769 struct rsc_mgr *mgr = &((struct srcimp_mgr *)data)->mgr;
770 struct hw *hw = mgr->hw;
772 hw->srcimp_mgr_set_imaparc(mgr->ctrl_blk, entry->slot);
773 hw->srcimp_mgr_set_imapuser(mgr->ctrl_blk, entry->user);
774 hw->srcimp_mgr_set_imapnxt(mgr->ctrl_blk, entry->next);
775 hw->srcimp_mgr_set_imapaddr(mgr->ctrl_blk, entry->addr);
776 hw->srcimp_mgr_commit_write(mgr->hw, mgr->ctrl_blk);
783 guard(spinlock_irqsave)(&mgr->imap_lock);
784 if ((0 == entry->addr) && (mgr->init_imap_added)) {
785 input_mapper_delete(&mgr->imappers,
786 mgr->init_imap, srcimp_map_op, mgr);
787 mgr->init_imap_added = 0;
789 return input_mapper_add(&mgr->imappers, entry, srcimp_map_op, mgr);
796 guard(spinlock_irqsave)(&mgr->imap_lock);
797 err = input_mapper_delete(&mgr->imappers, entry, srcimp_map_op, mgr);
798 if (list_empty(&mgr->imappers)) {
799 input_mapper_add(&mgr->imappers, mgr->init_imap,
801 mgr->init_imap_added = 1;
816 return -ENOMEM;
818 err = rsc_mgr_init(&srcimp_mgr->mgr, SRCIMP, SRCIMP_RESOURCE_NUM, hw);
822 spin_lock_init(&srcimp_mgr->mgr_lock);
823 spin_lock_init(&srcimp_mgr->imap_lock);
824 INIT_LIST_HEAD(&srcimp_mgr->imappers);
827 err = -ENOMEM;
830 entry->slot = entry->addr = entry->next = entry->user = 0;
831 list_add(&entry->list, &srcimp_mgr->imappers);
832 srcimp_mgr->init_imap = entry;
833 srcimp_mgr->init_imap_added = 1;
835 srcimp_mgr->get_srcimp = get_srcimp_rsc;
836 srcimp_mgr->put_srcimp = put_srcimp_rsc;
837 srcimp_mgr->imap_add = srcimp_imap_add;
838 srcimp_mgr->imap_delete = srcimp_imap_delete;
839 srcimp_mgr->card = hw->card;
846 rsc_mgr_uninit(&srcimp_mgr->mgr);
856 /* free src input mapper list */
857 scoped_guard(spinlock_irqsave, &srcimp_mgr->imap_lock) {
858 free_input_mapper_list(&srcimp_mgr->imappers);
861 rsc_mgr_uninit(&srcimp_mgr->mgr);