xscale/ixp425/ixp425_qmgr.c

178 static void aqm_int_enable(struct ixpqmgr_softc *sc, int qId);
179 static void aqm_int_disable(struct ixpqmgr_softc *sc, int qId);
180 static void aqm_qcfg(struct ixpqmgr_softc *sc, int qId, u_int ne, u_int nf);
181 static void aqm_srcsel_write(struct ixpqmgr_softc *sc, int qId, int sourceId);
185 dummyCallback(int qId, void *arg)
340 ixpqmgr_qconfig(int qId, int qEntries, int ne, int nf, int srcSel,
344 	struct qmgrInfo *qi = &sc->qinfo[qId];
347 	    __func__, qId, qEntries, ne, nf, srcSel, cb, cbarg);
366 	aqm_qcfg(sc, qId, ne, nf);
373 	if (qId < IX_QMGR_MIN_QUEUPP_QID)
374 	    aqm_srcsel_write(sc, qId, srcSel);
377 	    aqm_int_enable(sc, qId);
385 ixpqmgr_qwrite(int qId, uint32_t entry)
388 	struct qmgrInfo *qi = &sc->qinfo[qId];
391 	    __func__, qId, entry, qi->qWriteCount, qi->qSizeInEntries);
397 	if (qId < IX_QMGR_MIN_QUEUPP_QID) {
421 			__func__, qId, entry);
434 		    __func__, qId, entry, qPtrs);
454 ixpqmgr_qread(int qId, uint32_t *entry)
457 	struct qmgrInfo *qi = &sc->qinfo[qId];
469 	if (*entry == 0 && qId < IX_QMGR_MIN_QUEUPP_QID) {
483 ixpqmgr_qreadm(int qId, uint32_t n, uint32_t *p)
486 	struct qmgrInfo *qi = &sc->qinfo[qId];
508 	if (entry == 0 && qId < IX_QMGR_MIN_QUEUPP_QID) {
522 ixpqmgr_getqstatus(int qId)
527 	const struct qmgrInfo *qi = &sc->qinfo[qId];
530 	if (qId < IX_QMGR_MIN_QUEUPP_QID) {
548 ixpqmgr_getqconfig(int qId)
552 	return aqm_reg_read(sc, IX_QMGR_Q_CONFIG_ADDR_GET(qId));
628 ixpqmgr_notify_enable(int qId, int srcSel)
633 	aqm_calc_statuscheck(sc, qId, srcSel);
636 	if (qId < IX_QMGR_MIN_QUEUPP_QID)
637 	    aqm_srcsel_write(sc, qId, srcSel);
640 	aqm_int_enable(sc, qId);
644 ixpqmgr_notify_disable(int qId)
648 	aqm_int_disable(sc, qId);
818 aqm_calc_statuscheck(int qId, IxQMgrSourceId srcSel)
820 	struct qmgrInfo *qi = &qinfo[qId];
823 	if (qId < IX_QMGR_MIN_QUEUPP_QID) {
866 	    shiftVal = (qId % IX_QMGR_QUELOWSTAT_NUM_QUE_PER_WORD) *
869 	    /* Calculate the which status word to check from the qId,
872 	    qi->statusWordOffset = qId / IX_QMGR_QUELOWSTAT_NUM_QUE_PER_WORD;
882 	    qi->statusMask = 1 << (qId - IX_QMGR_MIN_QUEUPP_QID);
889 aqm_int_enable(struct ixpqmgr_softc *sc, int qId)
894 	if (qId < IX_QMGR_MIN_QUEUPP_QID)
899 	aqm_reg_write(sc, reg, v | (1 << (qId % IX_QMGR_MIN_QUEUPP_QID)));
902 	    __func__, qId, reg, v, aqm_reg_read(sc, reg));
906 aqm_int_disable(struct ixpqmgr_softc *sc, int qId)
911 	if (qId < IX_QMGR_MIN_QUEUPP_QID)
916 	aqm_reg_write(sc, reg, v &~ (1 << (qId % IX_QMGR_MIN_QUEUPP_QID)));
919 	    __func__, qId, reg, v, aqm_reg_read(sc, reg));
959 aqm_qcfg(struct ixpqmgr_softc *sc, int qId, u_int ne, u_int nf)
961 	const struct qmgrInfo *qi = &sc->qinfo[qId];
987 	    __func__, qId, ne, nf,
988 	    aqm_reg_read(sc, IX_QMGR_Q_CONFIG_ADDR_GET(qId)),
989 	    qCfg, IX_QMGR_Q_CONFIG_ADDR_GET(qId));
991 	aqm_reg_write(sc, IX_QMGR_Q_CONFIG_ADDR_GET(qId), qCfg);
995 aqm_srcsel_write(struct ixpqmgr_softc *sc, int qId, int sourceId)
1004 	    ((qId / IX_QMGR_INTSRC_NUM_QUE_PER_WORD) * sizeof(uint32_t));
1007 	if (off == IX_QMGR_INT0SRCSELREG0_OFFSET && qId == 0) {
1015 	  qshift = (qId & (IX_QMGR_INTSRC_NUM_QUE_PER_WORD-1)) * bpq;
1023 	    __func__, qId, sourceId, aqm_reg_read(sc, off), v, off);