^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Copyright (C) 2008, Creative Technology Ltd. All Rights Reserved.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * @File ctsrc.c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * @Brief
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * This file contains the implementation of the Sample Rate Convertor
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * resource management object.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) * @Author Liu Chun
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) * @Date May 13 2008
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include "ctsrc.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include "cthardware.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #define SRC_RESOURCE_NUM 256
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #define SRCIMP_RESOURCE_NUM 256
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) static unsigned int conj_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) static int src_default_config_memrd(struct src *src);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) static int src_default_config_memwr(struct src *src);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) static int src_default_config_arcrw(struct src *src);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) static int (*src_default_config[3])(struct src *) = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) [MEMRD] = src_default_config_memrd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) [MEMWR] = src_default_config_memwr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) [ARCRW] = src_default_config_arcrw
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) static int src_set_state(struct src *src, unsigned int state)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) struct hw *hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) hw->src_set_state(src->rsc.ctrl_blk, state);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) static int src_set_bm(struct src *src, unsigned int bm)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) struct hw *hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) hw->src_set_bm(src->rsc.ctrl_blk, bm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) static int src_set_sf(struct src *src, unsigned int sf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) struct hw *hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) hw->src_set_sf(src->rsc.ctrl_blk, sf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) static int src_set_pm(struct src *src, unsigned int pm)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) struct hw *hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) hw->src_set_pm(src->rsc.ctrl_blk, pm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) static int src_set_rom(struct src *src, unsigned int rom)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) struct hw *hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) hw->src_set_rom(src->rsc.ctrl_blk, rom);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) static int src_set_vo(struct src *src, unsigned int vo)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) struct hw *hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) hw->src_set_vo(src->rsc.ctrl_blk, vo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) static int src_set_st(struct src *src, unsigned int st)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) struct hw *hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) hw->src_set_st(src->rsc.ctrl_blk, st);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) static int src_set_bp(struct src *src, unsigned int bp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) struct hw *hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) hw->src_set_bp(src->rsc.ctrl_blk, bp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) static int src_set_cisz(struct src *src, unsigned int cisz)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) struct hw *hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) hw->src_set_cisz(src->rsc.ctrl_blk, cisz);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) static int src_set_ca(struct src *src, unsigned int ca)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) struct hw *hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) hw->src_set_ca(src->rsc.ctrl_blk, ca);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) static int src_set_sa(struct src *src, unsigned int sa)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) struct hw *hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) hw->src_set_sa(src->rsc.ctrl_blk, sa);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) static int src_set_la(struct src *src, unsigned int la)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) struct hw *hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) hw->src_set_la(src->rsc.ctrl_blk, la);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) static int src_set_pitch(struct src *src, unsigned int pitch)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) struct hw *hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) hw->src_set_pitch(src->rsc.ctrl_blk, pitch);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) static int src_set_clear_zbufs(struct src *src)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) struct hw *hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) hw->src_set_clear_zbufs(src->rsc.ctrl_blk, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) static int src_commit_write(struct src *src)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) struct hw *hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) unsigned int dirty = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) src->rsc.ops->master(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) if (src->rsc.msr > 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) /* Save dirty flags for conjugate resource programming */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) dirty = hw->src_get_dirty(src->rsc.ctrl_blk) & conj_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) hw->src_commit_write(hw, src->rsc.ops->index(&src->rsc),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) src->rsc.ctrl_blk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) /* Program conjugate parameter mixer resources */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) if (MEMWR == src->mode)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) for (i = 1; i < src->rsc.msr; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) src->rsc.ops->next_conj(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) hw->src_set_dirty(src->rsc.ctrl_blk, dirty);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) hw->src_commit_write(hw, src->rsc.ops->index(&src->rsc),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) src->rsc.ctrl_blk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) src->rsc.ops->master(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) static int src_get_ca(struct src *src)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) struct hw *hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) return hw->src_get_ca(hw, src->rsc.ops->index(&src->rsc),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) src->rsc.ctrl_blk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) static int src_init(struct src *src)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) src_default_config[src->mode](src);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) static struct src *src_next_interleave(struct src *src)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) return src->intlv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) static int src_default_config_memrd(struct src *src)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) struct hw *hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) unsigned int rsr, msr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) hw->src_set_state(src->rsc.ctrl_blk, SRC_STATE_OFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) hw->src_set_bm(src->rsc.ctrl_blk, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) for (rsr = 0, msr = src->rsc.msr; msr > 1; msr >>= 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) rsr++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) hw->src_set_rsr(src->rsc.ctrl_blk, rsr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) hw->src_set_sf(src->rsc.ctrl_blk, SRC_SF_S16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) hw->src_set_wr(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) hw->src_set_pm(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) hw->src_set_rom(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) hw->src_set_vo(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) hw->src_set_st(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) hw->src_set_ilsz(src->rsc.ctrl_blk, src->multi - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) hw->src_set_cisz(src->rsc.ctrl_blk, 0x80);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) hw->src_set_sa(src->rsc.ctrl_blk, 0x0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) hw->src_set_la(src->rsc.ctrl_blk, 0x1000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) hw->src_set_ca(src->rsc.ctrl_blk, 0x80);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) hw->src_set_pitch(src->rsc.ctrl_blk, 0x1000000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) hw->src_set_clear_zbufs(src->rsc.ctrl_blk, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) src->rsc.ops->master(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) hw->src_commit_write(hw, src->rsc.ops->index(&src->rsc),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) src->rsc.ctrl_blk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) for (msr = 1; msr < src->rsc.msr; msr++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) src->rsc.ops->next_conj(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) hw->src_set_pitch(src->rsc.ctrl_blk, 0x1000000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) hw->src_commit_write(hw, src->rsc.ops->index(&src->rsc),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) src->rsc.ctrl_blk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) src->rsc.ops->master(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) static int src_default_config_memwr(struct src *src)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) struct hw *hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) hw->src_set_state(src->rsc.ctrl_blk, SRC_STATE_OFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) hw->src_set_bm(src->rsc.ctrl_blk, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) hw->src_set_rsr(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) hw->src_set_sf(src->rsc.ctrl_blk, SRC_SF_S16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) hw->src_set_wr(src->rsc.ctrl_blk, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) hw->src_set_pm(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) hw->src_set_rom(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) hw->src_set_vo(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) hw->src_set_st(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) hw->src_set_ilsz(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) hw->src_set_cisz(src->rsc.ctrl_blk, 0x80);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) hw->src_set_sa(src->rsc.ctrl_blk, 0x0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) hw->src_set_la(src->rsc.ctrl_blk, 0x1000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) hw->src_set_ca(src->rsc.ctrl_blk, 0x80);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) hw->src_set_pitch(src->rsc.ctrl_blk, 0x1000000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) hw->src_set_clear_zbufs(src->rsc.ctrl_blk, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) src->rsc.ops->master(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) hw->src_commit_write(hw, src->rsc.ops->index(&src->rsc),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) src->rsc.ctrl_blk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) static int src_default_config_arcrw(struct src *src)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) struct hw *hw = src->rsc.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) unsigned int rsr, msr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) unsigned int dirty;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) hw->src_set_state(src->rsc.ctrl_blk, SRC_STATE_OFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) hw->src_set_bm(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) for (rsr = 0, msr = src->rsc.msr; msr > 1; msr >>= 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) rsr++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) hw->src_set_rsr(src->rsc.ctrl_blk, rsr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) hw->src_set_sf(src->rsc.ctrl_blk, SRC_SF_F32);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) hw->src_set_wr(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) hw->src_set_pm(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) hw->src_set_rom(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) hw->src_set_vo(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) hw->src_set_st(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) hw->src_set_ilsz(src->rsc.ctrl_blk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) hw->src_set_cisz(src->rsc.ctrl_blk, 0x80);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) hw->src_set_sa(src->rsc.ctrl_blk, 0x0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) /*hw->src_set_sa(src->rsc.ctrl_blk, 0x100);*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) hw->src_set_la(src->rsc.ctrl_blk, 0x1000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) /*hw->src_set_la(src->rsc.ctrl_blk, 0x03ffffe0);*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) hw->src_set_ca(src->rsc.ctrl_blk, 0x80);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) hw->src_set_pitch(src->rsc.ctrl_blk, 0x1000000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) hw->src_set_clear_zbufs(src->rsc.ctrl_blk, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) dirty = hw->src_get_dirty(src->rsc.ctrl_blk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) src->rsc.ops->master(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) for (msr = 0; msr < src->rsc.msr; msr++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) hw->src_set_dirty(src->rsc.ctrl_blk, dirty);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) hw->src_commit_write(hw, src->rsc.ops->index(&src->rsc),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) src->rsc.ctrl_blk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) src->rsc.ops->next_conj(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) src->rsc.ops->master(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) static const struct src_rsc_ops src_rsc_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) .set_state = src_set_state,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) .set_bm = src_set_bm,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) .set_sf = src_set_sf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) .set_pm = src_set_pm,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) .set_rom = src_set_rom,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) .set_vo = src_set_vo,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) .set_st = src_set_st,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) .set_bp = src_set_bp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) .set_cisz = src_set_cisz,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) .set_ca = src_set_ca,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) .set_sa = src_set_sa,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) .set_la = src_set_la,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) .set_pitch = src_set_pitch,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) .set_clr_zbufs = src_set_clear_zbufs,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) .commit_write = src_commit_write,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) .get_ca = src_get_ca,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) .init = src_init,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) .next_interleave = src_next_interleave,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) src_rsc_init(struct src *src, u32 idx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) const struct src_desc *desc, struct src_mgr *mgr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) int i, n;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) struct src *p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) n = (MEMRD == desc->mode) ? desc->multi : 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) for (i = 0, p = src; i < n; i++, p++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) err = rsc_init(&p->rsc, idx + i, SRC, desc->msr, mgr->mgr.hw);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) goto error1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) /* Initialize src specific rsc operations */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) p->ops = &src_rsc_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) p->multi = (0 == i) ? desc->multi : 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) p->mode = desc->mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) src_default_config[desc->mode](p);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) mgr->src_enable(mgr, p);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) p->intlv = p + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) (--p)->intlv = NULL; /* Set @intlv of the last SRC to NULL */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) mgr->commit_write(mgr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) error1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) for (i--, p--; i >= 0; i--, p--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) mgr->src_disable(mgr, p);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) rsc_uninit(&p->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) mgr->commit_write(mgr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) static int src_rsc_uninit(struct src *src, struct src_mgr *mgr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) int i, n;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) struct src *p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) n = (MEMRD == src->mode) ? src->multi : 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) for (i = 0, p = src; i < n; i++, p++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) mgr->src_disable(mgr, p);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) rsc_uninit(&p->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) p->multi = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) p->ops = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) p->mode = NUM_SRCMODES;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) p->intlv = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) mgr->commit_write(mgr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) get_src_rsc(struct src_mgr *mgr, const struct src_desc *desc, struct src **rsrc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) unsigned int idx = SRC_RESOURCE_NUM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) struct src *src;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) *rsrc = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) /* Check whether there are sufficient src resources to meet request. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) spin_lock_irqsave(&mgr->mgr_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) if (MEMRD == desc->mode)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) err = mgr_get_resource(&mgr->mgr, desc->multi, &idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) err = mgr_get_resource(&mgr->mgr, 1, &idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) spin_unlock_irqrestore(&mgr->mgr_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) if (err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) dev_err(mgr->card->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) "Can't meet SRC resource request!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) /* Allocate mem for master src resource */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) if (MEMRD == desc->mode)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) src = kcalloc(desc->multi, sizeof(*src), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) src = kzalloc(sizeof(*src), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) if (!src) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) err = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) goto error1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) err = src_rsc_init(src, idx, desc, mgr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) goto error2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) *rsrc = src;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) error2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) kfree(src);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) error1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) spin_lock_irqsave(&mgr->mgr_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) if (MEMRD == desc->mode)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) mgr_put_resource(&mgr->mgr, desc->multi, idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) mgr_put_resource(&mgr->mgr, 1, idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) spin_unlock_irqrestore(&mgr->mgr_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) static int put_src_rsc(struct src_mgr *mgr, struct src *src)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) spin_lock_irqsave(&mgr->mgr_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) src->rsc.ops->master(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) if (MEMRD == src->mode)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) mgr_put_resource(&mgr->mgr, src->multi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) src->rsc.ops->index(&src->rsc));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) mgr_put_resource(&mgr->mgr, 1, src->rsc.ops->index(&src->rsc));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) spin_unlock_irqrestore(&mgr->mgr_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) src_rsc_uninit(src, mgr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) kfree(src);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) static int src_enable_s(struct src_mgr *mgr, struct src *src)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) struct hw *hw = mgr->mgr.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) src->rsc.ops->master(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) for (i = 0; i < src->rsc.msr; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) hw->src_mgr_enbs_src(mgr->mgr.ctrl_blk,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) src->rsc.ops->index(&src->rsc));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) src->rsc.ops->next_conj(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) src->rsc.ops->master(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) static int src_enable(struct src_mgr *mgr, struct src *src)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) struct hw *hw = mgr->mgr.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) src->rsc.ops->master(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) for (i = 0; i < src->rsc.msr; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) hw->src_mgr_enb_src(mgr->mgr.ctrl_blk,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) src->rsc.ops->index(&src->rsc));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) src->rsc.ops->next_conj(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) src->rsc.ops->master(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) static int src_disable(struct src_mgr *mgr, struct src *src)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) struct hw *hw = mgr->mgr.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) src->rsc.ops->master(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) for (i = 0; i < src->rsc.msr; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) hw->src_mgr_dsb_src(mgr->mgr.ctrl_blk,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) src->rsc.ops->index(&src->rsc));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) src->rsc.ops->next_conj(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) src->rsc.ops->master(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) static int src_mgr_commit_write(struct src_mgr *mgr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) struct hw *hw = mgr->mgr.hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) hw->src_mgr_commit_write(hw, mgr->mgr.ctrl_blk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) int src_mgr_create(struct hw *hw, struct src_mgr **rsrc_mgr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) int err, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) struct src_mgr *src_mgr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) *rsrc_mgr = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) src_mgr = kzalloc(sizeof(*src_mgr), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) if (!src_mgr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) err = rsc_mgr_init(&src_mgr->mgr, SRC, SRC_RESOURCE_NUM, hw);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) goto error1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) spin_lock_init(&src_mgr->mgr_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) conj_mask = hw->src_dirty_conj_mask();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) src_mgr->get_src = get_src_rsc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) src_mgr->put_src = put_src_rsc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) src_mgr->src_enable_s = src_enable_s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) src_mgr->src_enable = src_enable;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) src_mgr->src_disable = src_disable;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) src_mgr->commit_write = src_mgr_commit_write;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) src_mgr->card = hw->card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) /* Disable all SRC resources. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) for (i = 0; i < 256; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) hw->src_mgr_dsb_src(src_mgr->mgr.ctrl_blk, i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) hw->src_mgr_commit_write(hw, src_mgr->mgr.ctrl_blk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) *rsrc_mgr = src_mgr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) error1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) kfree(src_mgr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) int src_mgr_destroy(struct src_mgr *src_mgr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) rsc_mgr_uninit(&src_mgr->mgr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) kfree(src_mgr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) /* SRCIMP resource manager operations */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) static void srcimp_master(struct rsc *rsc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) rsc->conj = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) rsc->idx = container_of(rsc, struct srcimp, rsc)->idx[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) static void srcimp_next_conj(struct rsc *rsc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) rsc->conj++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) static int srcimp_index(const struct rsc *rsc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) return container_of(rsc, struct srcimp, rsc)->idx[rsc->conj];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) static const struct rsc_ops srcimp_basic_rsc_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) .master = srcimp_master,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) .next_conj = srcimp_next_conj,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) .index = srcimp_index,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) .output_slot = NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) static int srcimp_map(struct srcimp *srcimp, struct src *src, struct rsc *input)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) struct imapper *entry;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) srcimp->rsc.ops->master(&srcimp->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) src->rsc.ops->master(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) input->ops->master(input);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) /* Program master and conjugate resources */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) for (i = 0; i < srcimp->rsc.msr; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) entry = &srcimp->imappers[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) entry->slot = input->ops->output_slot(input);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) entry->user = src->rsc.ops->index(&src->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) entry->addr = srcimp->rsc.ops->index(&srcimp->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) srcimp->mgr->imap_add(srcimp->mgr, entry);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) srcimp->mapped |= (0x1 << i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) srcimp->rsc.ops->next_conj(&srcimp->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) input->ops->next_conj(input);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) srcimp->rsc.ops->master(&srcimp->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) input->ops->master(input);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) static int srcimp_unmap(struct srcimp *srcimp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) /* Program master and conjugate resources */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) for (i = 0; i < srcimp->rsc.msr; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) if (srcimp->mapped & (0x1 << i)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) srcimp->mgr->imap_delete(srcimp->mgr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) &srcimp->imappers[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) srcimp->mapped &= ~(0x1 << i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) static const struct srcimp_rsc_ops srcimp_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) .map = srcimp_map,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) .unmap = srcimp_unmap
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) static int srcimp_rsc_init(struct srcimp *srcimp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) const struct srcimp_desc *desc,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) struct srcimp_mgr *mgr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) err = rsc_init(&srcimp->rsc, srcimp->idx[0],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) SRCIMP, desc->msr, mgr->mgr.hw);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) /* Reserve memory for imapper nodes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) srcimp->imappers = kcalloc(desc->msr, sizeof(struct imapper),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) if (!srcimp->imappers) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) err = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) goto error1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) /* Set srcimp specific operations */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) srcimp->rsc.ops = &srcimp_basic_rsc_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) srcimp->ops = &srcimp_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) srcimp->mgr = mgr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) srcimp->rsc.ops->master(&srcimp->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) error1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) rsc_uninit(&srcimp->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) static int srcimp_rsc_uninit(struct srcimp *srcimp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) kfree(srcimp->imappers);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) srcimp->imappers = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) srcimp->ops = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) srcimp->mgr = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) rsc_uninit(&srcimp->rsc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) static int get_srcimp_rsc(struct srcimp_mgr *mgr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) const struct srcimp_desc *desc,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) struct srcimp **rsrcimp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) int err, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) unsigned int idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) struct srcimp *srcimp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) *rsrcimp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) /* Allocate mem for SRCIMP resource */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) srcimp = kzalloc(sizeof(*srcimp), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) if (!srcimp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) /* Check whether there are sufficient SRCIMP resources. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) spin_lock_irqsave(&mgr->mgr_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728) for (i = 0; i < desc->msr; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729) err = mgr_get_resource(&mgr->mgr, 1, &idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) srcimp->idx[i] = idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) spin_unlock_irqrestore(&mgr->mgr_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) if (err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) dev_err(mgr->card->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738) "Can't meet SRCIMP resource request!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) goto error1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) err = srcimp_rsc_init(srcimp, desc, mgr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744) goto error1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746) *rsrcimp = srcimp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) error1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) spin_lock_irqsave(&mgr->mgr_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752) for (i--; i >= 0; i--)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753) mgr_put_resource(&mgr->mgr, 1, srcimp->idx[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755) spin_unlock_irqrestore(&mgr->mgr_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756) kfree(srcimp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760) static int put_srcimp_rsc(struct srcimp_mgr *mgr, struct srcimp *srcimp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765) spin_lock_irqsave(&mgr->mgr_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) for (i = 0; i < srcimp->rsc.msr; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) mgr_put_resource(&mgr->mgr, 1, srcimp->idx[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769) spin_unlock_irqrestore(&mgr->mgr_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770) srcimp_rsc_uninit(srcimp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771) kfree(srcimp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776) static int srcimp_map_op(void *data, struct imapper *entry)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778) struct rsc_mgr *mgr = &((struct srcimp_mgr *)data)->mgr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) struct hw *hw = mgr->hw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781) hw->srcimp_mgr_set_imaparc(mgr->ctrl_blk, entry->slot);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782) hw->srcimp_mgr_set_imapuser(mgr->ctrl_blk, entry->user);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783) hw->srcimp_mgr_set_imapnxt(mgr->ctrl_blk, entry->next);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784) hw->srcimp_mgr_set_imapaddr(mgr->ctrl_blk, entry->addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785) hw->srcimp_mgr_commit_write(mgr->hw, mgr->ctrl_blk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) static int srcimp_imap_add(struct srcimp_mgr *mgr, struct imapper *entry)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 794)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 795) spin_lock_irqsave(&mgr->imap_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 796) if ((0 == entry->addr) && (mgr->init_imap_added)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 797) input_mapper_delete(&mgr->imappers,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 798) mgr->init_imap, srcimp_map_op, mgr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 799) mgr->init_imap_added = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 800) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 801) err = input_mapper_add(&mgr->imappers, entry, srcimp_map_op, mgr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 802) spin_unlock_irqrestore(&mgr->imap_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 803)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 804) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 805) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 806)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 807) static int srcimp_imap_delete(struct srcimp_mgr *mgr, struct imapper *entry)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 808) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 809) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 810) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 811)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 812) spin_lock_irqsave(&mgr->imap_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 813) err = input_mapper_delete(&mgr->imappers, entry, srcimp_map_op, mgr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 814) if (list_empty(&mgr->imappers)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 815) input_mapper_add(&mgr->imappers, mgr->init_imap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 816) srcimp_map_op, mgr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 817) mgr->init_imap_added = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 818) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 819) spin_unlock_irqrestore(&mgr->imap_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 820)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 821) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 822) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 823)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 824) int srcimp_mgr_create(struct hw *hw, struct srcimp_mgr **rsrcimp_mgr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 825) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 826) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 827) struct srcimp_mgr *srcimp_mgr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 828) struct imapper *entry;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 829)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 830) *rsrcimp_mgr = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 831) srcimp_mgr = kzalloc(sizeof(*srcimp_mgr), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 832) if (!srcimp_mgr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 833) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 834)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 835) err = rsc_mgr_init(&srcimp_mgr->mgr, SRCIMP, SRCIMP_RESOURCE_NUM, hw);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 836) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 837) goto error1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 838)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 839) spin_lock_init(&srcimp_mgr->mgr_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 840) spin_lock_init(&srcimp_mgr->imap_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 841) INIT_LIST_HEAD(&srcimp_mgr->imappers);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 842) entry = kzalloc(sizeof(*entry), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 843) if (!entry) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 844) err = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 845) goto error2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 846) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 847) entry->slot = entry->addr = entry->next = entry->user = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 848) list_add(&entry->list, &srcimp_mgr->imappers);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 849) srcimp_mgr->init_imap = entry;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 850) srcimp_mgr->init_imap_added = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 851)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 852) srcimp_mgr->get_srcimp = get_srcimp_rsc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 853) srcimp_mgr->put_srcimp = put_srcimp_rsc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 854) srcimp_mgr->imap_add = srcimp_imap_add;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 855) srcimp_mgr->imap_delete = srcimp_imap_delete;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 856) srcimp_mgr->card = hw->card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 857)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 858) *rsrcimp_mgr = srcimp_mgr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 859)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 860) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 861)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 862) error2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 863) rsc_mgr_uninit(&srcimp_mgr->mgr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 864) error1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 865) kfree(srcimp_mgr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 866) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 867) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 868)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 869) int srcimp_mgr_destroy(struct srcimp_mgr *srcimp_mgr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 870) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 871) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 872)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 873) /* free src input mapper list */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 874) spin_lock_irqsave(&srcimp_mgr->imap_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 875) free_input_mapper_list(&srcimp_mgr->imappers);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 876) spin_unlock_irqrestore(&srcimp_mgr->imap_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 877)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 878) rsc_mgr_uninit(&srcimp_mgr->mgr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 879) kfree(srcimp_mgr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 880)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 881) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 882) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags