xscale/ixp425/ixp425_qmgr.c

177 static void aqm_int_enable(struct ixpqmgr_softc *sc, int qId);
178 static void aqm_int_disable(struct ixpqmgr_softc *sc, int qId);
179 static void aqm_qcfg(struct ixpqmgr_softc *sc, int qId, u_int ne, u_int nf);
180 static void aqm_srcsel_write(struct ixpqmgr_softc *sc, int qId, int sourceId);
184 dummyCallback(int qId, void *arg)
339 ixpqmgr_qconfig(int qId, int qEntries, int ne, int nf, int srcSel,
343 	struct qmgrInfo *qi = &sc->qinfo[qId];
346 	    __func__, qId, qEntries, ne, nf, srcSel, cb, cbarg);
365 	aqm_qcfg(sc, qId, ne, nf);
372 	if (qId < IX_QMGR_MIN_QUEUPP_QID)
373 	    aqm_srcsel_write(sc, qId, srcSel);
376 	    aqm_int_enable(sc, qId);
384 ixpqmgr_qwrite(int qId, uint32_t entry)
387 	struct qmgrInfo *qi = &sc->qinfo[qId];
390 	    __func__, qId, entry, qi->qWriteCount, qi->qSizeInEntries);
396 	if (qId < IX_QMGR_MIN_QUEUPP_QID) {
420 			__func__, qId, entry);
433 		    __func__, qId, entry, qPtrs);
453 ixpqmgr_qread(int qId, uint32_t *entry)
456 	struct qmgrInfo *qi = &sc->qinfo[qId];
468 	if (*entry == 0 && qId < IX_QMGR_MIN_QUEUPP_QID) {
482 ixpqmgr_qreadm(int qId, uint32_t n, uint32_t *p)
485 	struct qmgrInfo *qi = &sc->qinfo[qId];
507 	if (entry == 0 && qId < IX_QMGR_MIN_QUEUPP_QID) {
521 ixpqmgr_getqstatus(int qId)
526 	const struct qmgrInfo *qi = &sc->qinfo[qId];
529 	if (qId < IX_QMGR_MIN_QUEUPP_QID) {
547 ixpqmgr_getqconfig(int qId)
551 	return aqm_reg_read(sc, IX_QMGR_Q_CONFIG_ADDR_GET(qId));
627 ixpqmgr_notify_enable(int qId, int srcSel)
632 	aqm_calc_statuscheck(sc, qId, srcSel);
635 	if (qId < IX_QMGR_MIN_QUEUPP_QID)
636 	    aqm_srcsel_write(sc, qId, srcSel);
639 	aqm_int_enable(sc, qId);
643 ixpqmgr_notify_disable(int qId)
647 	aqm_int_disable(sc, qId);
817 aqm_calc_statuscheck(int qId, IxQMgrSourceId srcSel)
819 	struct qmgrInfo *qi = &qinfo[qId];
822 	if (qId < IX_QMGR_MIN_QUEUPP_QID) {
865 	    shiftVal = (qId % IX_QMGR_QUELOWSTAT_NUM_QUE_PER_WORD) *
868 	    /* Calculate the which status word to check from the qId,
871 	    qi->statusWordOffset = qId / IX_QMGR_QUELOWSTAT_NUM_QUE_PER_WORD;
881 	    qi->statusMask = 1 << (qId - IX_QMGR_MIN_QUEUPP_QID);
888 aqm_int_enable(struct ixpqmgr_softc *sc, int qId)
893 	if (qId < IX_QMGR_MIN_QUEUPP_QID)
898 	aqm_reg_write(sc, reg, v | (1 << (qId % IX_QMGR_MIN_QUEUPP_QID)));
901 	    __func__, qId, reg, v, aqm_reg_read(sc, reg));
905 aqm_int_disable(struct ixpqmgr_softc *sc, int qId)
910 	if (qId < IX_QMGR_MIN_QUEUPP_QID)
915 	aqm_reg_write(sc, reg, v &~ (1 << (qId % IX_QMGR_MIN_QUEUPP_QID)));
918 	    __func__, qId, reg, v, aqm_reg_read(sc, reg));
958 aqm_qcfg(struct ixpqmgr_softc *sc, int qId, u_int ne, u_int nf)
960 	const struct qmgrInfo *qi = &sc->qinfo[qId];
986 	    __func__, qId, ne, nf,
987 	    aqm_reg_read(sc, IX_QMGR_Q_CONFIG_ADDR_GET(qId)),
988 	    qCfg, IX_QMGR_Q_CONFIG_ADDR_GET(qId));
990 	aqm_reg_write(sc, IX_QMGR_Q_CONFIG_ADDR_GET(qId), qCfg);
994 aqm_srcsel_write(struct ixpqmgr_softc *sc, int qId, int sourceId)
1003 	    ((qId / IX_QMGR_INTSRC_NUM_QUE_PER_WORD) * sizeof(uint32_t));
1006 	if (off == IX_QMGR_INT0SRCSELREG0_OFFSET && qId == 0) {
1014 	  qshift = (qId & (IX_QMGR_INTSRC_NUM_QUE_PER_WORD-1)) * bpq;
1022 	    __func__, qId, sourceId, aqm_reg_read(sc, off), v, off);