1f5fbb83fSMauro Carvalho Chehab // SPDX-License-Identifier: GPL-2.0
29d4fa1a1SMauro Carvalho Chehab /*
39d4fa1a1SMauro Carvalho Chehab * Support for Intel Camera Imaging ISP subsystem.
43c0538fbSMauro Carvalho Chehab * Copyright (c) 2010 - 2015, Intel Corporation.
59d4fa1a1SMauro Carvalho Chehab *
69d4fa1a1SMauro Carvalho Chehab * This program is free software; you can redistribute it and/or modify it
79d4fa1a1SMauro Carvalho Chehab * under the terms and conditions of the GNU General Public License,
89d4fa1a1SMauro Carvalho Chehab * version 2, as published by the Free Software Foundation.
99d4fa1a1SMauro Carvalho Chehab *
109d4fa1a1SMauro Carvalho Chehab * This program is distributed in the hope it will be useful, but WITHOUT
119d4fa1a1SMauro Carvalho Chehab * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
129d4fa1a1SMauro Carvalho Chehab * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
139d4fa1a1SMauro Carvalho Chehab * more details.
149d4fa1a1SMauro Carvalho Chehab */
159d4fa1a1SMauro Carvalho Chehab
169d4fa1a1SMauro Carvalho Chehab #include "system_global.h"
179d4fa1a1SMauro Carvalho Chehab
18641c2292SMauro Carvalho Chehab #ifdef ISP2401
199d4fa1a1SMauro Carvalho Chehab
209d4fa1a1SMauro Carvalho Chehab #include "assert_support.h"
219d4fa1a1SMauro Carvalho Chehab #include "platform_support.h"
229d4fa1a1SMauro Carvalho Chehab #include "ia_css_isys.h"
239d4fa1a1SMauro Carvalho Chehab #include "bitop_support.h"
249d4fa1a1SMauro Carvalho Chehab #include "isys_stream2mmio_rmgr.h"
259d4fa1a1SMauro Carvalho Chehab
269d4fa1a1SMauro Carvalho Chehab static isys_stream2mmio_rsrc_t isys_stream2mmio_rsrc[N_STREAM2MMIO_ID];
279d4fa1a1SMauro Carvalho Chehab
ia_css_isys_stream2mmio_sid_rmgr_init(void)289d4fa1a1SMauro Carvalho Chehab void ia_css_isys_stream2mmio_sid_rmgr_init(void)
299d4fa1a1SMauro Carvalho Chehab {
309d4fa1a1SMauro Carvalho Chehab memset(isys_stream2mmio_rsrc, 0, sizeof(isys_stream2mmio_rsrc));
319d4fa1a1SMauro Carvalho Chehab }
329d4fa1a1SMauro Carvalho Chehab
ia_css_isys_stream2mmio_sid_rmgr_uninit(void)339d4fa1a1SMauro Carvalho Chehab void ia_css_isys_stream2mmio_sid_rmgr_uninit(void)
349d4fa1a1SMauro Carvalho Chehab {
359d4fa1a1SMauro Carvalho Chehab memset(isys_stream2mmio_rsrc, 0, sizeof(isys_stream2mmio_rsrc));
369d4fa1a1SMauro Carvalho Chehab }
379d4fa1a1SMauro Carvalho Chehab
ia_css_isys_stream2mmio_sid_rmgr_acquire(stream2mmio_ID_t stream2mmio,stream2mmio_sid_ID_t * sid)389d4fa1a1SMauro Carvalho Chehab bool ia_css_isys_stream2mmio_sid_rmgr_acquire(
399d4fa1a1SMauro Carvalho Chehab stream2mmio_ID_t stream2mmio,
409d4fa1a1SMauro Carvalho Chehab stream2mmio_sid_ID_t *sid)
419d4fa1a1SMauro Carvalho Chehab {
429d4fa1a1SMauro Carvalho Chehab bool retval = false;
439d4fa1a1SMauro Carvalho Chehab stream2mmio_sid_ID_t max_sid;
449d4fa1a1SMauro Carvalho Chehab isys_stream2mmio_rsrc_t *cur_rsrc = NULL;
459d4fa1a1SMauro Carvalho Chehab stream2mmio_sid_ID_t i;
469d4fa1a1SMauro Carvalho Chehab
479d4fa1a1SMauro Carvalho Chehab assert(stream2mmio < N_STREAM2MMIO_ID);
489d4fa1a1SMauro Carvalho Chehab assert(sid);
499d4fa1a1SMauro Carvalho Chehab
509d4fa1a1SMauro Carvalho Chehab if ((stream2mmio < N_STREAM2MMIO_ID) && (sid)) {
519d4fa1a1SMauro Carvalho Chehab max_sid = N_STREAM2MMIO_SID_PROCS[stream2mmio];
529d4fa1a1SMauro Carvalho Chehab cur_rsrc = &isys_stream2mmio_rsrc[stream2mmio];
539d4fa1a1SMauro Carvalho Chehab
549d4fa1a1SMauro Carvalho Chehab if (cur_rsrc->num_active < max_sid) {
559d4fa1a1SMauro Carvalho Chehab for (i = STREAM2MMIO_SID0_ID; i < max_sid; i++) {
569d4fa1a1SMauro Carvalho Chehab if (bitop_getbit(cur_rsrc->active_table, i) == 0) {
579d4fa1a1SMauro Carvalho Chehab bitop_setbit(cur_rsrc->active_table, i);
589d4fa1a1SMauro Carvalho Chehab *sid = i;
599d4fa1a1SMauro Carvalho Chehab cur_rsrc->num_active++;
609d4fa1a1SMauro Carvalho Chehab retval = true;
619d4fa1a1SMauro Carvalho Chehab break;
629d4fa1a1SMauro Carvalho Chehab }
639d4fa1a1SMauro Carvalho Chehab }
649d4fa1a1SMauro Carvalho Chehab }
659d4fa1a1SMauro Carvalho Chehab }
669d4fa1a1SMauro Carvalho Chehab return retval;
679d4fa1a1SMauro Carvalho Chehab }
689d4fa1a1SMauro Carvalho Chehab
ia_css_isys_stream2mmio_sid_rmgr_release(stream2mmio_ID_t stream2mmio,stream2mmio_sid_ID_t * sid)699d4fa1a1SMauro Carvalho Chehab void ia_css_isys_stream2mmio_sid_rmgr_release(
709d4fa1a1SMauro Carvalho Chehab stream2mmio_ID_t stream2mmio,
719d4fa1a1SMauro Carvalho Chehab stream2mmio_sid_ID_t *sid)
729d4fa1a1SMauro Carvalho Chehab {
739d4fa1a1SMauro Carvalho Chehab stream2mmio_sid_ID_t max_sid;
749d4fa1a1SMauro Carvalho Chehab isys_stream2mmio_rsrc_t *cur_rsrc = NULL;
759d4fa1a1SMauro Carvalho Chehab
769d4fa1a1SMauro Carvalho Chehab assert(stream2mmio < N_STREAM2MMIO_ID);
779d4fa1a1SMauro Carvalho Chehab assert(sid);
789d4fa1a1SMauro Carvalho Chehab
799d4fa1a1SMauro Carvalho Chehab if ((stream2mmio < N_STREAM2MMIO_ID) && (sid)) {
809d4fa1a1SMauro Carvalho Chehab max_sid = N_STREAM2MMIO_SID_PROCS[stream2mmio];
819d4fa1a1SMauro Carvalho Chehab cur_rsrc = &isys_stream2mmio_rsrc[stream2mmio];
829d4fa1a1SMauro Carvalho Chehab if ((*sid < max_sid) && (cur_rsrc->num_active > 0)) {
839d4fa1a1SMauro Carvalho Chehab if (bitop_getbit(cur_rsrc->active_table, *sid) == 1) {
849d4fa1a1SMauro Carvalho Chehab bitop_clearbit(cur_rsrc->active_table, *sid);
859d4fa1a1SMauro Carvalho Chehab cur_rsrc->num_active--;
869d4fa1a1SMauro Carvalho Chehab }
879d4fa1a1SMauro Carvalho Chehab }
889d4fa1a1SMauro Carvalho Chehab }
899d4fa1a1SMauro Carvalho Chehab }
909d4fa1a1SMauro Carvalho Chehab #endif
91