Beispiel #1
0
static void xgene_cle_idt_to_hw(u32 dstqid, u32 fpsel,
				u32 nfpsel, u32 *idt_reg)
{
	*idt_reg =  SET_VAL(IDT_DSTQID, dstqid) |
		    SET_VAL(IDT_FPSEL, fpsel) |
		    SET_VAL(IDT_NFPSEL, nfpsel);
}
Beispiel #2
0
static int xgene_xfi_mdio_read(struct mii_bus *bus, int phy_id, int reg)
{
	void __iomem *addr = (void __iomem *)bus->priv;
	u32 data, status, val;
	int timeout = 100;

	val = SET_VAL(HSTPHYADX, phy_id) | SET_VAL(HSTREGADX, reg);
	xgene_enet_wr_mdio_csr(addr, MIIM_FIELD_ADDR, val);

	val = HSTLDCMD | SET_VAL(HSTMIIMCMD, MIIM_CMD_LEGACY_READ);
	xgene_enet_wr_mdio_csr(addr, MIIM_COMMAND_ADDR, val);

	do {
		usleep_range(5, 10);
		xgene_enet_rd_mdio_csr(addr, MIIM_INDICATOR_ADDR, &status);
	} while ((status & BUSY_MASK) && timeout--);

	if (status & BUSY_MASK) {
		pr_err("XGENET_MII_MGMT write failed\n");
		return -EBUSY;
	}

	xgene_enet_rd_mdio_csr(addr, MIIMRD_FIELD_ADDR, &data);
	xgene_enet_wr_mdio_csr(addr, MIIM_COMMAND_ADDR, 0);

	return data;
}
Beispiel #3
0
void PropertiesDialog::TransferTo(Catalog *cat)
{
    SetCharsetToCombobox(m_charset, cat->Header().Charset);
    SetCharsetToCombobox(m_sourceCodeCharset, cat->Header().SourceCodeCharset);

    #define SET_VAL(what,what2) m_##what2->SetValue(cat->Header().what)
    SET_VAL(Team, team);
    SET_VAL(TeamEmail, teamEmail);
    SET_VAL(Project, project);
    SET_VAL(BasePath, basePath);
    #undef SET_VAL

    m_language->SetLang(cat->Header().Lang);
    OnLanguageValueChanged(m_language->GetValue());

    wxString pf_def = cat->Header().Lang.DefaultPluralFormsExpr();
    wxString pf_cat = cat->Header().GetHeader("Plural-Forms");
    if (pf_cat == "nplurals=INTEGER; plural=EXPRESSION;")
        pf_cat = pf_def;

    m_pluralFormsExpr->SetValue(pf_cat);
    if (!pf_cat.empty() && pf_cat == pf_def)
        m_pluralFormsDefault->SetValue(true);
    else
        m_pluralFormsCustom->SetValue(true);

    m_paths->SetStrings(cat->Header().SearchPaths);
    m_keywords->SetStrings(cat->Header().Keywords);
}
Beispiel #4
0
/* interfaces to convert structures to HW recognized bit formats */
static void xgene_cle_sband_to_hw(u8 frag, enum xgene_cle_prot_version ver,
				  enum xgene_cle_prot_type type, u32 len,
				  u32 *reg)
{
	*reg =  SET_VAL(SB_IPFRAG, frag) |
		SET_VAL(SB_IPPROT, type) |
		SET_VAL(SB_IPVER, ver) |
		SET_VAL(SB_HDRLEN, len);
}
Beispiel #5
0
static void xgene_cle_dbptr_to_hw(struct xgene_enet_pdata *pdata,
				  struct xgene_cle_dbptr *dbptr, u32 *buf)
{
	buf[0] = SET_VAL(CLE_DROP, dbptr->drop);
	buf[4] = SET_VAL(CLE_FPSEL, dbptr->fpsel) |
		 SET_VAL(CLE_DSTQIDL, dbptr->dstqid);

	buf[5] = SET_VAL(CLE_DSTQIDH, (u32)dbptr->dstqid >> CLE_DSTQIDL_LEN) |
		 SET_VAL(CLE_PRIORITY, dbptr->cle_priority);
}
Beispiel #6
0
void planMAMsgSetDTGReq(plan_ma_msg_t *msg, int var, int from, int to)
{
    plan_ma_msg_dtg_req_t *dr;

    msg->header |= M_dtg_req;
    dr = &msg->dtg_req;
    SET_VAL(dr, var, var);
    SET_VAL(dr, val_from, from);
    SET_VAL(dr, val_to, to);
}
Beispiel #7
0
static void xgene_enet_init_bufpool(struct xgene_enet_desc_ring *buf_pool)
{
    struct xgene_enet_raw_desc16 *raw_desc;
    int i;

    for (i = 0; i < buf_pool->slots; i++) {
        raw_desc = &buf_pool->raw_desc16[i];

        /* Hardware expects descriptor in little endian format */
        raw_desc->m0 = cpu_to_le64(i |
                                   SET_VAL(FPQNUM, buf_pool->dst_ring_num) |
                                   SET_VAL(STASH, 3));
    }
}
Beispiel #8
0
tween_t * tween_new(void *ptr, tween_type_t type, unsigned int total_steps, tween_value_t start, tween_value_t end, 
                                tween_dir_t dir, tween_func_t tween_cb) {
    tween_t *tween = mem_alloc(sizeof(tween_t));
    tween->ptr.ptr = ptr;
    tween->type = type;
    tween->steps = (dir == TWEEN_IN ? 0 : total_steps);
    tween->total_steps = total_steps;
    SET_VAL(tween, tween->current, (dir == TWEEN_IN ? 0 : GET_VAL(tween, start) - GET_VAL(tween, end)));
    SET_VAL(tween, tween->end, (dir == TWEEN_IN ? GET_VAL(tween, end) - GET_VAL(tween, start) : GET_VAL(tween, start) - GET_VAL(tween, end)));
    tween->dir = dir;
    tween->tween_cb = tween_cb;
    link_init(&(tween->all_tweens_link));
    link_init(&(tween->tweens_link));
    return tween;
}
Beispiel #9
0
static int xgene_enet_refill_bufpool(struct xgene_enet_desc_ring *buf_pool,
				     u32 nbuf)
{
	struct sk_buff *skb;
	struct xgene_enet_raw_desc16 *raw_desc;
	struct xgene_enet_pdata *pdata;
	struct net_device *ndev;
	struct device *dev;
	dma_addr_t dma_addr;
	u32 tail = buf_pool->tail;
	u32 slots = buf_pool->slots - 1;
	u16 bufdatalen, len;
	int i;

	ndev = buf_pool->ndev;
	dev = ndev_to_dev(buf_pool->ndev);
	pdata = netdev_priv(ndev);
	bufdatalen = BUF_LEN_CODE_2K | (SKB_BUFFER_SIZE & GENMASK(11, 0));
	len = XGENE_ENET_MAX_MTU;

	for (i = 0; i < nbuf; i++) {
		raw_desc = &buf_pool->raw_desc16[tail];

		skb = netdev_alloc_skb_ip_align(ndev, len);
		if (unlikely(!skb))
			return -ENOMEM;
		buf_pool->rx_skb[tail] = skb;

		dma_addr = dma_map_single(dev, skb->data, len, DMA_FROM_DEVICE);
		if (dma_mapping_error(dev, dma_addr)) {
			netdev_err(ndev, "DMA mapping error\n");
			dev_kfree_skb_any(skb);
			return -EINVAL;
		}

		raw_desc->m1 = cpu_to_le64(SET_VAL(DATAADDR, dma_addr) |
					   SET_VAL(BUFDATALEN, bufdatalen) |
					   SET_BIT(COHERENT));
		tail = (tail + 1) & slots;
	}

	pdata->ring_ops->wr_cmd(buf_pool, nbuf);
	buf_pool->tail = tail;

	return 0;
}
Beispiel #10
0
plan_ma_msg_t *planMAMsgSnapshotNewResponse(const plan_ma_msg_t *sshot_init,
                                            int agent_id)
{
    plan_ma_msg_t *msg = planMAMsgNew(PLAN_MA_MSG_SNAPSHOT,
                                      PLAN_MA_MSG_SNAPSHOT_RESPONSE, agent_id);
    SET_VAL(msg, snapshot_token, planMAMsgSnapshotToken(sshot_init));
    planMAMsgSetSnapshotType(msg, planMAMsgSnapshotType(sshot_init));
    return msg;
}
Beispiel #11
0
void PropertiesDialog::TransferTo(Catalog *cat)
{
    SetCharsetToCombobox(m_charset, cat->Header().Charset);
    SetCharsetToCombobox(m_sourceCodeCharset, cat->Header().SourceCodeCharset);

    #define SET_VAL(what,what2) m_##what2->SetValue(cat->Header().what)
    SET_VAL(Team, team);
    SET_VAL(TeamEmail, teamEmail);
    SET_VAL(Project, project);
    SET_VAL(BasePath, basePath);
    SET_VAL(LanguageCode, language);
    #undef SET_VAL

    if (cat->Header().HasHeader(_T("Plural-Forms")))
        m_pluralForms->SetValue(cat->Header().GetHeader(_T("Plural-Forms")));

    m_paths->SetStrings(cat->Header().SearchPaths);
    m_keywords->SetStrings(cat->Header().Keywords);
}
Beispiel #12
0
static void xgene_cle_kn_to_hw(struct xgene_cle_ptree_kn *kn, u32 *buf)
{
	u32 i, j = 0;
	u32 data;

	buf[j++] = SET_VAL(CLE_TYPE, kn->node_type);
	for (i = 0; i < kn->num_keys; i++) {
		struct xgene_cle_ptree_key *key = &kn->key[i];

		if (!(i % 2)) {
			buf[j] = SET_VAL(CLE_KN_PRIO, key->priority) |
				 SET_VAL(CLE_KN_RPTR, key->result_pointer);
		} else {
			data = SET_VAL(CLE_KN_PRIO, key->priority) |
			       SET_VAL(CLE_KN_RPTR, key->result_pointer);
			buf[j++] |= (data << 16);
		}
	}
}
Beispiel #13
0
void planMAMsgInit(plan_ma_msg_t *msg, int type, int subtype, int agent_id)
{
    int32_t stype;

    bzero(msg, sizeof(*msg));
    stype = (subtype << 4) | type;
    SET_VAL(msg, type, stype);
    SET_VAL(msg, agent_id, agent_id);

    if (type == PLAN_MA_MSG_TRACE_PATH){
        SET_VAL(msg, initiator_agent_id, agent_id);

    }else if (type == PLAN_MA_MSG_SNAPSHOT
                && subtype == PLAN_MA_MSG_SNAPSHOT_INIT){
        uint64_t token = __sync_fetch_and_add(&snapshot_token_counter, 1);
        token = token << 32;
        token = token | (uint32_t)agent_id;
        SET_VAL(msg, snapshot_token, token);
    }
}
Beispiel #14
0
int xgene_mdio_rgmii_write(struct mii_bus *bus, int phy_id, int reg, u16 data)
{
	struct xgene_mdio_pdata *pdata = (struct xgene_mdio_pdata *)bus->priv;
	u32 val, done;
	u8 wait = 10;

	val = SET_VAL(PHY_ADDR, phy_id) | SET_VAL(REG_ADDR, reg);
	xgene_mdio_wr_mac(pdata, MII_MGMT_ADDRESS_ADDR, val);

	xgene_mdio_wr_mac(pdata, MII_MGMT_CONTROL_ADDR, data);
	do {
		usleep_range(5, 10);
		done = xgene_mdio_rd_mac(pdata, MII_MGMT_INDICATORS_ADDR);
	} while ((done & BUSY_MASK) && wait--);

	if (done & BUSY_MASK) {
		dev_err(&bus->dev, "MII_MGMT write failed\n");
		return -EBUSY;
	}

	return 0;
}
Beispiel #15
0
static void xgene_xgmac_set_mss(struct xgene_enet_pdata *pdata,
				u16 mss, u8 index)
{
	u8 offset;
	u32 data;

	offset = (index < 2) ? 0 : 4;
	xgene_enet_rd_csr(pdata, XG_TSIF_MSS_REG0_ADDR + offset, &data);

	if (!(index & 0x1))
		data = SET_VAL(TSO_MSS1, data >> TSO_MSS1_POS) |
			SET_VAL(TSO_MSS0, mss);
	else
Beispiel #16
0
static int xgene_xfi_mdio_write(struct mii_bus *bus, int phy_id,
				int reg, u16 data)
{
	void __iomem *addr = (void __iomem *)bus->priv;
	int timeout = 100;
	u32 status, val;

	val = SET_VAL(HSTPHYADX, phy_id) | SET_VAL(HSTREGADX, reg) |
	      SET_VAL(HSTMIIMWRDAT, data);
	xgene_enet_wr_mdio_csr(addr, MIIM_FIELD_ADDR, val);

	val = HSTLDCMD | SET_VAL(HSTMIIMCMD, MIIM_CMD_LEGACY_WRITE);
	xgene_enet_wr_mdio_csr(addr, MIIM_COMMAND_ADDR, val);

	do {
		usleep_range(5, 10);
		xgene_enet_rd_mdio_csr(addr, MIIM_INDICATOR_ADDR, &status);
	} while ((status & BUSY_MASK) && timeout--);

	xgene_enet_wr_mdio_csr(addr, MIIM_COMMAND_ADDR, 0);

	return 0;
}
Beispiel #17
0
int xgene_mdio_rgmii_read(struct mii_bus *bus, int phy_id, int reg)
{
	struct xgene_mdio_pdata *pdata = (struct xgene_mdio_pdata *)bus->priv;
	u32 data, done;
	u8 wait = 10;

	data = SET_VAL(PHY_ADDR, phy_id) | SET_VAL(REG_ADDR, reg);
	xgene_mdio_wr_mac(pdata, MII_MGMT_ADDRESS_ADDR, data);
	xgene_mdio_wr_mac(pdata, MII_MGMT_COMMAND_ADDR, READ_CYCLE_MASK);
	do {
		usleep_range(5, 10);
		done = xgene_mdio_rd_mac(pdata, MII_MGMT_INDICATORS_ADDR);
	} while ((done & BUSY_MASK) && wait--);

	if (done & BUSY_MASK) {
		dev_err(&bus->dev, "MII_MGMT read failed\n");
		return -EBUSY;
	}

	data = xgene_mdio_rd_mac(pdata, MII_MGMT_STATUS_ADDR);
	xgene_mdio_wr_mac(pdata, MII_MGMT_COMMAND_ADDR, 0);

	return data;
}
// Set data port and toggle e pin
void send_data (uint8_t data) {
  uint8_t part;

  // send upper bit
  part = data >> 4;
  SET_VAL (LCD_DATA_PORT, LCD_DATA7_PIN, BIT_VAL(part, 3));
  SET_VAL (LCD_DATA_PORT, LCD_DATA6_PIN, BIT_VAL(part, 2));
  SET_VAL (LCD_DATA_PORT, LCD_DATA5_PIN, BIT_VAL(part, 1));
  SET_VAL (LCD_DATA_PORT, LCD_DATA4_PIN, BIT_VAL(part, 0));
  toggle_e_pin ();

  // send lower bit
  part = data;
  SET_VAL (LCD_DATA_PORT, LCD_DATA7_PIN, BIT_VAL(part, 3));
  SET_VAL (LCD_DATA_PORT, LCD_DATA6_PIN, BIT_VAL(part, 2));
  SET_VAL (LCD_DATA_PORT, LCD_DATA5_PIN, BIT_VAL(part, 1));
  SET_VAL (LCD_DATA_PORT, LCD_DATA4_PIN, BIT_VAL(part, 0));
  toggle_e_pin ();
}
Beispiel #19
0
static void xgene_cle_idt_to_hw(struct xgene_enet_pdata *pdata,
				u32 dstqid, u32 fpsel,
				u32 nfpsel, u32 *idt_reg)
{
	if (pdata->enet_id == XGENE_ENET1) {
		*idt_reg = SET_VAL(IDT_DSTQID, dstqid) |
			   SET_VAL(IDT_FPSEL1, fpsel)  |
			   SET_VAL(IDT_NFPSEL1, nfpsel);
	} else {
		*idt_reg = SET_VAL(IDT_DSTQID, dstqid) |
			   SET_VAL(IDT_FPSEL, fpsel)   |
			   SET_VAL(IDT_NFPSEL, nfpsel);
	}
}
Beispiel #20
0
static int analop(RAnal *anal, RAnalOp *op, ut64 addr, const ut8 *buf, int len) {
	int n, ret, opsize = -1;
	static csh hndl = 0;
	static csh *handle = &hndl;
	static int omode = -1;
	static int obits = 32;
	cs_insn* insn;
	int mode = anal->big_endian? CS_MODE_BIG_ENDIAN: CS_MODE_LITTLE_ENDIAN;

	mode |= (anal->bits==64)? CS_MODE_64: CS_MODE_32;
	if (mode != omode || anal->bits != obits) {
		cs_close (&hndl);
		hndl = 0;
		omode = mode;
		obits = anal->bits;
	}
// XXX no arch->cpu ?!?! CS_MODE_MICRO, N64
	op->delay = 0;
	op->type = R_ANAL_OP_TYPE_ILL;
	if (len<4)
		return -1;
	op->size = 4;
	if (hndl == 0) {
		ret = cs_open (CS_ARCH_MIPS, mode, &hndl);
		if (ret != CS_ERR_OK) goto fin;
		cs_option (hndl, CS_OPT_DETAIL, CS_OPT_ON);
	}
	n = cs_disasm (hndl, (ut8*)buf, len, addr, 1, &insn);
	if (n<1 || insn->size<1)
		goto beach;
	op->type = R_ANAL_OP_TYPE_NULL;
	op->delay = 0;
	op->jump = UT64_MAX;
	op->fail = UT64_MAX;
	opsize = op->size = insn->size;
	switch (insn->id) {
	case MIPS_INS_INVALID:
		op->type = R_ANAL_OP_TYPE_ILL;
		break;
	case MIPS_INS_LB:
	case MIPS_INS_LBU:
	case MIPS_INS_LBUX:
	case MIPS_INS_LW:
	case MIPS_INS_LWC1:
	case MIPS_INS_LWC2:
	case MIPS_INS_LWL:
	case MIPS_INS_LWR:
	case MIPS_INS_LWXC1:
	case MIPS_INS_LD:
	case MIPS_INS_LDC1:
	case MIPS_INS_LDC2:
	case MIPS_INS_LDL:
	case MIPS_INS_LDR:
	case MIPS_INS_LDXC1:
		op->type = R_ANAL_OP_TYPE_LOAD;
		op->refptr = 4;
		switch (OPERAND(1).type) {
		case MIPS_OP_MEM:
			if (OPERAND(1).mem.base == MIPS_REG_GP) {
				op->ptr = anal->gp + OPERAND(1).mem.disp;
				op->refptr = 4;
			}
			break;
		case MIPS_OP_IMM:
			op->ptr = OPERAND(1).imm;
			break;
		case MIPS_OP_REG:
			// wtf?
			break;
		default:
			break;
		}
		// TODO: fill
		break;
	case MIPS_INS_SW:
	case MIPS_INS_SWC1:
	case MIPS_INS_SWC2:
	case MIPS_INS_SWL:
	case MIPS_INS_SWR:
	case MIPS_INS_SWXC1:
		op->type = R_ANAL_OP_TYPE_STORE;
		break;
	case MIPS_INS_NOP:
		op->type = R_ANAL_OP_TYPE_NOP;
		break;
	case MIPS_INS_SYSCALL:
	case MIPS_INS_BREAK:
		op->type = R_ANAL_OP_TYPE_TRAP;
		break;
	case MIPS_INS_JALR:
		op->type = R_ANAL_OP_TYPE_UCALL;
		op->delay = 1;
		break;
	case MIPS_INS_JAL:
	case MIPS_INS_JALS:
	case MIPS_INS_JALX:
	case MIPS_INS_JRADDIUSP:
	case MIPS_INS_BAL:
	// (no blezal/bgtzal or blezall/bgtzall, only blezalc/bgtzalc)
	case MIPS_INS_BLTZAL: // Branch on <0 and link
	case MIPS_INS_BGEZAL: // Branch on >=0 and link
	case MIPS_INS_BLTZALL: // "likely" versions
	case MIPS_INS_BGEZALL:
	case MIPS_INS_BLTZALC: // compact versions
	case MIPS_INS_BLEZALC:
	case MIPS_INS_BGEZALC:
	case MIPS_INS_BGTZALC:
	case MIPS_INS_JIALC:
	case MIPS_INS_JIC:
		op->type = R_ANAL_OP_TYPE_CALL;
		op->jump = IMM(0);

		switch (insn->id) {
		case MIPS_INS_JIALC:
		case MIPS_INS_JIC:
		case MIPS_INS_BLTZALC:
		case MIPS_INS_BLEZALC:
		case MIPS_INS_BGEZALC:
		case MIPS_INS_BGTZALC:
			// compact vesions (no delay)
			op->delay = 0;
			op->fail = addr+4;
			break;
		default:
			op->delay = 1;
			op->fail = addr+8;
			break;
		}
		break;
	case MIPS_INS_LUI:
	case MIPS_INS_MOVE:
		op->type = R_ANAL_OP_TYPE_MOV;
		SET_SRC_DST_2_REGS (op);
		break;
	case MIPS_INS_ADD:
	case MIPS_INS_ADDI:
	case MIPS_INS_ADDU:
	case MIPS_INS_ADDIU:
	case MIPS_INS_DADD:
	case MIPS_INS_DADDI:
	case MIPS_INS_DADDIU:
		SET_VAL (op, 2);
		SET_SRC_DST_3_REG_OR_IMM (op);
		op->type = R_ANAL_OP_TYPE_ADD;
		break;
	case MIPS_INS_SUB:
	case MIPS_INS_SUBV:
	case MIPS_INS_SUBVI:
	case MIPS_INS_DSUBU:
	case MIPS_INS_FSUB:
	case MIPS_INS_FMSUB:
	case MIPS_INS_SUBU:
	case MIPS_INS_DSUB:
	case MIPS_INS_SUBS_S:
	case MIPS_INS_SUBS_U:
	case MIPS_INS_SUBUH:
	case MIPS_INS_SUBUH_R:
		SET_VAL (op,2);
		SET_SRC_DST_3_REG_OR_IMM (op);
		op->type = R_ANAL_OP_TYPE_SUB;
		break;
	case MIPS_INS_MULV:
	case MIPS_INS_MULT:
	case MIPS_INS_MULSA:
	case MIPS_INS_FMUL:
	case MIPS_INS_MUL:
	case MIPS_INS_DMULT:
	case MIPS_INS_DMULTU:
		op->type = R_ANAL_OP_TYPE_MUL;
		break;
	case MIPS_INS_XOR:
	case MIPS_INS_XORI:
		SET_VAL (op,2);
		SET_SRC_DST_3_REG_OR_IMM (op);
		op->type = R_ANAL_OP_TYPE_XOR;
		break;
	case MIPS_INS_AND:
	case MIPS_INS_ANDI:
		SET_VAL (op,2);
		SET_SRC_DST_3_REG_OR_IMM (op);
		op->type = R_ANAL_OP_TYPE_AND;
		break;
	case MIPS_INS_NOT:
		op->type = R_ANAL_OP_TYPE_NOT;
		break;
	case MIPS_INS_OR:
	case MIPS_INS_ORI:
		SET_VAL (op,2);
		SET_SRC_DST_3_REG_OR_IMM (op);
		op->type = R_ANAL_OP_TYPE_OR;
		break;
	case MIPS_INS_DIV:
	case MIPS_INS_DIVU:
	case MIPS_INS_DDIV:
	case MIPS_INS_DDIVU:
	case MIPS_INS_FDIV:
	case MIPS_INS_DIV_S:
	case MIPS_INS_DIV_U:
		SET_SRC_DST_3_REGS (op);
		op->type = R_ANAL_OP_TYPE_DIV;
		break;
	case MIPS_INS_CMPGDU:
	case MIPS_INS_CMPGU:
	case MIPS_INS_CMPU:
	case MIPS_INS_CMPI:
		op->type = R_ANAL_OP_TYPE_CMP;
		break;
	case MIPS_INS_J:
	case MIPS_INS_B:
	case MIPS_INS_BZ:
	case MIPS_INS_BEQ:
	case MIPS_INS_BNZ:
	case MIPS_INS_BNE:
	case MIPS_INS_BEQZ:
	case MIPS_INS_BNEG:
	case MIPS_INS_BNEGI:
	case MIPS_INS_BNEZ:
	case MIPS_INS_BTEQZ:
	case MIPS_INS_BTNEZ:
	case MIPS_INS_BLTZ:
	case MIPS_INS_BLTZL:
	case MIPS_INS_BLEZ:
	case MIPS_INS_BLEZL:
	case MIPS_INS_BGEZ:
	case MIPS_INS_BGEZL:
	case MIPS_INS_BGTZ:
	case MIPS_INS_BGTZL:
	case MIPS_INS_BLEZC:
	case MIPS_INS_BGEZC:
	case MIPS_INS_BLTZC:
	case MIPS_INS_BGTZC:
		if (insn->id == MIPS_INS_J || insn->id == MIPS_INS_B ) {
			op->type = R_ANAL_OP_TYPE_JMP;
		} else {
			op->type = R_ANAL_OP_TYPE_CJMP;
		}
		
		if (OPERAND(0).type == MIPS_OP_IMM) {
			op->jump = IMM(0);
		} else if (OPERAND(1).type == MIPS_OP_IMM) {
			op->jump = IMM(1);
		} else if (OPERAND(2).type == MIPS_OP_IMM) {
			op->jump = IMM(2);
		}

		switch (insn->id) {
		case MIPS_INS_BLEZC:
		case MIPS_INS_BGEZC:
		case MIPS_INS_BLTZC:
		case MIPS_INS_BGTZC:
			// compact vesions (no delay)
			op->delay = 0;
			op->fail = addr+4;
			break;
		default:
			op->delay = 1;
			op->fail = addr+8;
			break;
		}
		
		break;
	case MIPS_INS_JR:
	case MIPS_INS_JRC:
		op->type = R_ANAL_OP_TYPE_JMP;
		op->delay = 1;
        // register is $ra, so jmp is a return
        if (insn->detail->mips.operands[0].reg == MIPS_REG_RA) {
            op->type = R_ANAL_OP_TYPE_RET;
        }
		break;
	case MIPS_INS_SLTI:
	case MIPS_INS_SLTIU:
		SET_SRC_DST_3_IMM (op);
		SET_VAL (op,2);
		break;

	case MIPS_INS_SHRAV:
	case MIPS_INS_SHRAV_R:
	case MIPS_INS_SHRA:
	case MIPS_INS_SHRA_R:
	case MIPS_INS_SRA:
		op->type = R_ANAL_OP_TYPE_SAR;
		SET_SRC_DST_3_REG_OR_IMM (op);
		SET_VAL (op,2);
		break;
	case MIPS_INS_SHRL:
	case MIPS_INS_SRLV:
	case MIPS_INS_SRL:
		op->type = R_ANAL_OP_TYPE_SHR;
		SET_SRC_DST_3_REG_OR_IMM (op);
		SET_VAL (op,2);
		break;
	case MIPS_INS_SLLV:
	case MIPS_INS_SLL:
		op->type = R_ANAL_OP_TYPE_SHL;
		SET_SRC_DST_3_REG_OR_IMM (op);
		SET_VAL (op,2);
		break;
	}
	beach:
	if (anal->decode) {
		if (analop_esil (anal, op, addr, buf, len, &hndl, insn) != 0)
			r_strbuf_fini (&op->esil);
	}
	cs_free (insn, n);
	//cs_close (&handle);
	fin:
	return opsize;
}
Beispiel #21
0
void
Interpret (int pop_return_p)
{
    long dispatch_code;
    struct interpreter_state_s new_state;

    /* Primitives jump back here for errors, requests to evaluate an
       expression, apply a function, or handle an interrupt request.  On
       errors or interrupts they leave their arguments on the stack, the
       primitive itself in GET_EXP.  The code should do a primitive
       backout in these cases, but not in others (apply, eval, etc.),
       since the primitive itself will have left the state of the
       interpreter ready for operation.  */

    bind_interpreter_state (&new_state);
    dispatch_code = (setjmp (interpreter_catch_env));
    preserve_signal_mask ();
    fixup_float_environment ();

    switch (dispatch_code)
    {
    case 0:			/* first time */
        if (pop_return_p)
            goto pop_return;	/* continue */
        else
            break;			/* fall into eval */

    case PRIM_APPLY:
        PROCEED_AFTER_PRIMITIVE ();
        goto internal_apply;

    case PRIM_NO_TRAP_APPLY:
        PROCEED_AFTER_PRIMITIVE ();
        goto Apply_Non_Trapping;

    case PRIM_APPLY_INTERRUPT:
        PROCEED_AFTER_PRIMITIVE ();
        PREPARE_APPLY_INTERRUPT ();
        SIGNAL_INTERRUPT (PENDING_INTERRUPTS ());

    case PRIM_APPLY_ERROR:
        PROCEED_AFTER_PRIMITIVE ();
        APPLICATION_ERROR (prim_apply_error_code);

    case PRIM_DO_EXPRESSION:
        SET_VAL (GET_EXP);
        PROCEED_AFTER_PRIMITIVE ();
        REDUCES_TO (GET_VAL);

    case PRIM_NO_TRAP_EVAL:
        SET_VAL (GET_EXP);
        PROCEED_AFTER_PRIMITIVE ();
        NEW_REDUCTION (GET_VAL, GET_ENV);
        goto eval_non_trapping;

    case PRIM_POP_RETURN:
        PROCEED_AFTER_PRIMITIVE ();
        goto pop_return;

    case PRIM_RETURN_TO_C:
        PROCEED_AFTER_PRIMITIVE ();
        unbind_interpreter_state (interpreter_state);
        return;

    case PRIM_NO_TRAP_POP_RETURN:
        PROCEED_AFTER_PRIMITIVE ();
        goto pop_return_non_trapping;

    case PRIM_INTERRUPT:
        back_out_of_primitive ();
        SIGNAL_INTERRUPT (PENDING_INTERRUPTS ());

    case PRIM_ABORT_TO_C:
        back_out_of_primitive ();
        unbind_interpreter_state (interpreter_state);
        return;

    case ERR_ARG_1_WRONG_TYPE:
        back_out_of_primitive ();
        Do_Micro_Error (ERR_ARG_1_WRONG_TYPE, true);
        goto internal_apply;

    case ERR_ARG_2_WRONG_TYPE:
        back_out_of_primitive ();
        Do_Micro_Error (ERR_ARG_2_WRONG_TYPE, true);
        goto internal_apply;

    case ERR_ARG_3_WRONG_TYPE:
        back_out_of_primitive ();
        Do_Micro_Error (ERR_ARG_3_WRONG_TYPE, true);
        goto internal_apply;

    default:
        back_out_of_primitive ();
        Do_Micro_Error (dispatch_code, true);
        goto internal_apply;
    }

do_expression:

    /* GET_EXP has an Scode item in it that should be evaluated and the
       result left in GET_VAL.

       A "break" after the code for any operation indicates that all
       processing for this operation has been completed, and the next
       step will be to pop a return code off the stack and proceed at
       pop_return.  This is sometimes called "executing the
       continuation" since the return code can be considered the
       continuation to be performed after the operation.

       An operation can terminate with a REDUCES_TO or REDUCES_TO_NTH
       macro.  This indicates that the value of the current Scode item
       is the value returned when the new expression is evaluated.
       Therefore no new continuation is created and processing continues
       at do_expression with the new expression in GET_EXP.

       Finally, an operation can terminate with a DO_NTH_THEN macro.
       This indicates that another expression must be evaluated and them
       some additional processing will be performed before the value of
       this S-Code item available.  Thus a new continuation is created
       and placed on the stack (using SAVE_CONT), the new expression is
       placed in the GET_EXP, and processing continues at do_expression.
       */

    /* Handling of Eval Trapping.

       If we are handling traps and there is an Eval Trap set, turn off
       all trapping and then go to internal_apply to call the user
       supplied eval hook with the expression to be evaluated and the
       environment.  */

#ifdef COMPILE_STEPPER
    if (trapping
            && (!WITHIN_CRITICAL_SECTION_P ())
            && ((FETCH_EVAL_TRAPPER ()) != SHARP_F))
    {
        trapping = false;
        Will_Push (4);
        PUSH_ENV ();
        PUSH_EXP ();
        STACK_PUSH (FETCH_EVAL_TRAPPER ());
        PUSH_APPLY_FRAME_HEADER (2);
        Pushed ();
        goto Apply_Non_Trapping;
    }
#endif /* COMPILE_STEPPER */

eval_non_trapping:
#ifdef EVAL_UCODE_HOOK
    EVAL_UCODE_HOOK ();
#endif
    switch (OBJECT_TYPE (GET_EXP))
    {
    case TC_BIG_FIXNUM:         /* The self evaluating items */
    case TC_BIG_FLONUM:
    case TC_CHARACTER_STRING:
    case TC_CHARACTER:
    case TC_COMPILED_CODE_BLOCK:
    case TC_COMPLEX:
    case TC_CONTROL_POINT:
    case TC_DELAYED:
    case TC_ENTITY:
    case TC_ENVIRONMENT:
    case TC_EXTENDED_PROCEDURE:
    case TC_FIXNUM:
    case TC_HUNK3_A:
    case TC_HUNK3_B:
    case TC_INTERNED_SYMBOL:
    case TC_LIST:
    case TC_NON_MARKED_VECTOR:
    case TC_NULL:
    case TC_PRIMITIVE:
    case TC_PROCEDURE:
    case TC_QUAD:
    case TC_RATNUM:
    case TC_REFERENCE_TRAP:
    case TC_RETURN_CODE:
    case TC_UNINTERNED_SYMBOL:
    case TC_CONSTANT:
    case TC_VECTOR:
    case TC_VECTOR_16B:
    case TC_VECTOR_1B:
    default:
        SET_VAL (GET_EXP);
        break;

    case TC_ACCESS:
        Will_Push (CONTINUATION_SIZE);
        PUSH_NTH_THEN (RC_EXECUTE_ACCESS_FINISH, ACCESS_ENVIRONMENT);

    case TC_ASSIGNMENT:
        Will_Push (CONTINUATION_SIZE + 1);
        PUSH_ENV ();
        PUSH_NTH_THEN (RC_EXECUTE_ASSIGNMENT_FINISH, ASSIGN_VALUE);

    case TC_BROKEN_HEART:
        Microcode_Termination (TERM_BROKEN_HEART);

    case TC_COMBINATION:
    {
        long length = ((VECTOR_LENGTH (GET_EXP)) - 1);
        Will_Push (length + 2 + CONTINUATION_SIZE);
        stack_pointer = (STACK_LOC (-length));
        STACK_PUSH (MAKE_OBJECT (TC_MANIFEST_NM_VECTOR, length));
        /* The finger: last argument number */
        Pushed ();
        if (length == 0)
        {
            PUSH_APPLY_FRAME_HEADER (0); /* Frame size */
            DO_NTH_THEN (RC_COMB_APPLY_FUNCTION, COMB_FN_SLOT);
        }
        PUSH_ENV ();
        DO_NTH_THEN (RC_COMB_SAVE_VALUE, (length + 1));
    }

    case TC_COMBINATION_1:
        Will_Eventually_Push (CONTINUATION_SIZE + STACK_ENV_FIRST_ARG + 1);
        PUSH_ENV ();
        DO_NTH_THEN (RC_COMB_1_PROCEDURE, COMB_1_ARG_1);

    case TC_COMBINATION_2:
        Will_Eventually_Push (CONTINUATION_SIZE + STACK_ENV_FIRST_ARG + 2);
        PUSH_ENV ();
        DO_NTH_THEN (RC_COMB_2_FIRST_OPERAND, COMB_2_ARG_2);

    case TC_COMMENT:
        REDUCES_TO_NTH (COMMENT_EXPRESSION);

    case TC_CONDITIONAL:
        Will_Push (CONTINUATION_SIZE + 1);
        PUSH_ENV ();
        PUSH_NTH_THEN (RC_CONDITIONAL_DECIDE, COND_PREDICATE);

#ifdef CC_SUPPORT_P
    case TC_COMPILED_ENTRY:
        dispatch_code = (enter_compiled_expression ());
        goto return_from_compiled_code;
#endif

    case TC_DEFINITION:
        Will_Push (CONTINUATION_SIZE + 1);
        PUSH_ENV ();
        PUSH_NTH_THEN (RC_EXECUTE_DEFINITION_FINISH, DEFINE_VALUE);

    case TC_DELAY:
        /* Deliberately omitted: EVAL_GC_CHECK (2); */
        SET_VAL (MAKE_POINTER_OBJECT (TC_DELAYED, Free));
        (Free[THUNK_ENVIRONMENT]) = GET_ENV;
        (Free[THUNK_PROCEDURE]) = (MEMORY_REF (GET_EXP, DELAY_OBJECT));
        Free += 2;
        break;

    case TC_DISJUNCTION:
        Will_Push (CONTINUATION_SIZE + 1);
        PUSH_ENV ();
        PUSH_NTH_THEN (RC_DISJUNCTION_DECIDE, OR_PREDICATE);

    case TC_EXTENDED_LAMBDA:
        /* Deliberately omitted: EVAL_GC_CHECK (2); */
        SET_VAL (MAKE_POINTER_OBJECT (TC_EXTENDED_PROCEDURE, Free));
        (Free[PROCEDURE_LAMBDA_EXPR]) = GET_EXP;
        (Free[PROCEDURE_ENVIRONMENT]) = GET_ENV;
        Free += 2;
        break;

    case TC_IN_PACKAGE:
        Will_Push (CONTINUATION_SIZE);
        PUSH_NTH_THEN (RC_EXECUTE_IN_PACKAGE_CONTINUE, IN_PACKAGE_ENVIRONMENT);

    case TC_LAMBDA:
    case TC_LEXPR:
        /* Deliberately omitted: EVAL_GC_CHECK (2); */
        SET_VAL (MAKE_POINTER_OBJECT (TC_PROCEDURE, Free));
        (Free[PROCEDURE_LAMBDA_EXPR]) = GET_EXP;
        (Free[PROCEDURE_ENVIRONMENT]) = GET_ENV;
        Free += 2;
        break;

    case TC_MANIFEST_NM_VECTOR:
        EVAL_ERROR (ERR_EXECUTE_MANIFEST_VECTOR);

    case TC_PCOMB0:
        /* The argument to Will_Eventually_Push is determined by how
        much will be on the stack if we back out of the primitive.  */
        Will_Eventually_Push (CONTINUATION_SIZE + STACK_ENV_FIRST_ARG);
        Finished_Eventual_Pushing (CONTINUATION_SIZE + STACK_ENV_FIRST_ARG);
        SET_EXP (OBJECT_NEW_TYPE (TC_PRIMITIVE, GET_EXP));
        goto primitive_internal_apply;

    case TC_PCOMB1:
        Will_Eventually_Push (CONTINUATION_SIZE + STACK_ENV_FIRST_ARG + 1);
        DO_NTH_THEN (RC_PCOMB1_APPLY, PCOMB1_ARG_SLOT);

    case TC_PCOMB2:
        Will_Eventually_Push (CONTINUATION_SIZE + STACK_ENV_FIRST_ARG + 2);
        PUSH_ENV ();
        DO_NTH_THEN (RC_PCOMB2_DO_1, PCOMB2_ARG_2_SLOT);

    case TC_PCOMB3:
        Will_Eventually_Push (CONTINUATION_SIZE + STACK_ENV_FIRST_ARG + 3);
        PUSH_ENV ();
        DO_NTH_THEN (RC_PCOMB3_DO_2, PCOMB3_ARG_3_SLOT);

    case TC_SCODE_QUOTE:
        SET_VAL (MEMORY_REF (GET_EXP, SCODE_QUOTE_OBJECT));
        break;

    case TC_SEQUENCE_2:
        Will_Push (CONTINUATION_SIZE + 1);
        PUSH_ENV ();
        PUSH_NTH_THEN (RC_SEQ_2_DO_2, SEQUENCE_1);

    case TC_SEQUENCE_3:
        Will_Push (CONTINUATION_SIZE + 1);
        PUSH_ENV ();
        PUSH_NTH_THEN (RC_SEQ_3_DO_2, SEQUENCE_1);

    case TC_SYNTAX_ERROR:
        EVAL_ERROR (ERR_SYNTAX_ERROR);

    case TC_THE_ENVIRONMENT:
        SET_VAL (GET_ENV);
        break;

    case TC_VARIABLE:
    {
        SCHEME_OBJECT val = GET_VAL;
        SCHEME_OBJECT name = (GET_VARIABLE_SYMBOL (GET_EXP));
        long temp = (lookup_variable (GET_ENV, name, (&val)));
        if (temp != PRIM_DONE)
        {
            /* Back out of the evaluation. */
            if (temp == PRIM_INTERRUPT)
            {
                PREPARE_EVAL_REPEAT ();
                SIGNAL_INTERRUPT (PENDING_INTERRUPTS ());
            }
            EVAL_ERROR (temp);
        }
        SET_VAL (val);
    }
    }

    /* Now restore the continuation saved during an earlier part of the
       EVAL cycle and continue as directed.  */

pop_return:

#ifdef COMPILE_STEPPER
    if (trapping
            && (!WITHIN_CRITICAL_SECTION_P ())
            && ((FETCH_RETURN_TRAPPER ()) != SHARP_F))
    {
        Will_Push (3);
        trapping = false;
        PUSH_VAL ();
        STACK_PUSH (FETCH_RETURN_TRAPPER ());
        PUSH_APPLY_FRAME_HEADER (1);
        Pushed ();
        goto Apply_Non_Trapping;
    }
#endif /* COMPILE_STEPPER */

pop_return_non_trapping:
#ifdef POP_RETURN_UCODE_HOOK
    POP_RETURN_UCODE_HOOK ();
#endif
    RESTORE_CONT ();
#ifdef ENABLE_DEBUGGING_TOOLS
    if (!RETURN_CODE_P (GET_RET))
    {
        PUSH_VAL ();		/* For possible stack trace */
        SAVE_CONT ();
        Microcode_Termination (TERM_BAD_STACK);
    }
#endif

    /* Dispatch on the return code.  A BREAK here will cause
       a "goto pop_return" to occur, since this is the most
       common occurrence.
     */

    switch (OBJECT_DATUM (GET_RET))
    {
    case RC_COMB_1_PROCEDURE:
        POP_ENV ();
        PUSH_VAL ();		/* Arg. 1 */
        STACK_PUSH (SHARP_F);	/* Operator */
        PUSH_APPLY_FRAME_HEADER (1);
        Finished_Eventual_Pushing (CONTINUATION_SIZE);
        DO_ANOTHER_THEN (RC_COMB_APPLY_FUNCTION, COMB_1_FN);

    case RC_COMB_2_FIRST_OPERAND:
        POP_ENV ();
        PUSH_VAL ();
        PUSH_ENV ();
        DO_ANOTHER_THEN (RC_COMB_2_PROCEDURE, COMB_2_ARG_1);

    case RC_COMB_2_PROCEDURE:
        POP_ENV ();
        PUSH_VAL ();		/* Arg 1, just calculated */
        STACK_PUSH (SHARP_F);	/* Function */
        PUSH_APPLY_FRAME_HEADER (2);
        Finished_Eventual_Pushing (CONTINUATION_SIZE);
        DO_ANOTHER_THEN (RC_COMB_APPLY_FUNCTION, COMB_2_FN);

    case RC_COMB_APPLY_FUNCTION:
        END_SUBPROBLEM ();
        goto internal_apply_val;

    case RC_COMB_SAVE_VALUE:
    {
        long Arg_Number;

        POP_ENV ();
        Arg_Number = ((OBJECT_DATUM (STACK_REF (STACK_COMB_FINGER))) - 1);
        (STACK_REF (STACK_COMB_FIRST_ARG + Arg_Number)) = GET_VAL;
        (STACK_REF (STACK_COMB_FINGER))
            = (MAKE_OBJECT (TC_MANIFEST_NM_VECTOR, Arg_Number));
        /* DO NOT count on the type code being NMVector here, since
           the stack parser may create them with #F here! */
        if (Arg_Number > 0)
        {
            PUSH_ENV ();
            DO_ANOTHER_THEN
            (RC_COMB_SAVE_VALUE, ((COMB_ARG_1_SLOT - 1) + Arg_Number));
        }
        /* Frame Size */
        STACK_PUSH (MEMORY_REF (GET_EXP, 0));
        DO_ANOTHER_THEN (RC_COMB_APPLY_FUNCTION, COMB_FN_SLOT);
    }

#ifdef CC_SUPPORT_P

#define DEFINE_COMPILER_RESTART(return_code, entry)			\
case return_code:							\
  {									\
	dispatch_code = (entry ());					\
	goto return_from_compiled_code;					\
  }

    DEFINE_COMPILER_RESTART
    (RC_COMP_INTERRUPT_RESTART, comp_interrupt_restart);

    DEFINE_COMPILER_RESTART
    (RC_COMP_LOOKUP_TRAP_RESTART, comp_lookup_trap_restart);

    DEFINE_COMPILER_RESTART
    (RC_COMP_ASSIGNMENT_TRAP_RESTART, comp_assignment_trap_restart);

    DEFINE_COMPILER_RESTART
    (RC_COMP_OP_REF_TRAP_RESTART, comp_op_lookup_trap_restart);

    DEFINE_COMPILER_RESTART
    (RC_COMP_CACHE_REF_APPLY_RESTART, comp_cache_lookup_apply_restart);

    DEFINE_COMPILER_RESTART
    (RC_COMP_SAFE_REF_TRAP_RESTART, comp_safe_lookup_trap_restart);

    DEFINE_COMPILER_RESTART
    (RC_COMP_UNASSIGNED_TRAP_RESTART, comp_unassigned_p_trap_restart);

    DEFINE_COMPILER_RESTART
    (RC_COMP_LINK_CACHES_RESTART, comp_link_caches_restart);

    DEFINE_COMPILER_RESTART
    (RC_COMP_ERROR_RESTART, comp_error_restart);

    case RC_REENTER_COMPILED_CODE:
        dispatch_code = (return_to_compiled_code ());
        goto return_from_compiled_code;

#endif

    case RC_CONDITIONAL_DECIDE:
        END_SUBPROBLEM ();
        POP_ENV ();
        REDUCES_TO_NTH
        ((GET_VAL == SHARP_F) ? COND_ALTERNATIVE : COND_CONSEQUENT);

    case RC_DISJUNCTION_DECIDE:
        /* Return predicate if it isn't #F; else do ALTERNATIVE */
        END_SUBPROBLEM ();
        POP_ENV ();
        if (GET_VAL != SHARP_F)
            goto pop_return;
        REDUCES_TO_NTH (OR_ALTERNATIVE);

    case RC_END_OF_COMPUTATION:
    {
        /* Signals bottom of stack */

        interpreter_state_t previous_state;
        previous_state = (interpreter_state -> previous_state);
        if (previous_state == NULL_INTERPRETER_STATE)
        {
            termination_end_of_computation ();
            /*NOTREACHED*/
        }
        else
        {
            dstack_position = interpreter_catch_dstack_position;
            interpreter_state = previous_state;
            return;
        }
    }

    case RC_EVAL_ERROR:
        /* Should be called RC_REDO_EVALUATION. */
        POP_ENV ();
        REDUCES_TO (GET_EXP);

    case RC_EXECUTE_ACCESS_FINISH:
    {
        SCHEME_OBJECT val;
        long code;

        code = (lookup_variable (GET_VAL,
                                 (MEMORY_REF (GET_EXP, ACCESS_NAME)),
                                 (&val)));
        if (code == PRIM_DONE)
            SET_VAL (val);
        else if (code == PRIM_INTERRUPT)
        {
            PREPARE_POP_RETURN_INTERRUPT (RC_EXECUTE_ACCESS_FINISH, GET_VAL);
            SIGNAL_INTERRUPT (PENDING_INTERRUPTS ());
        }
        else
            POP_RETURN_ERROR (code);
    }
    END_SUBPROBLEM ();
    break;

    case RC_EXECUTE_ASSIGNMENT_FINISH:
    {
        SCHEME_OBJECT variable = (MEMORY_REF (GET_EXP, ASSIGN_NAME));
        SCHEME_OBJECT old_val;
        long code;

        POP_ENV ();
        if (TC_VARIABLE == (OBJECT_TYPE (variable)))
            code = (assign_variable (GET_ENV,
                                     (GET_VARIABLE_SYMBOL (variable)),
                                     GET_VAL,
                                     (&old_val)));
        else
            code = ERR_BAD_FRAME;
        if (code == PRIM_DONE)
            SET_VAL (old_val);
        else
        {
            PUSH_ENV ();
            if (code == PRIM_INTERRUPT)
            {
                PREPARE_POP_RETURN_INTERRUPT
                (RC_EXECUTE_ASSIGNMENT_FINISH, GET_VAL);
                SIGNAL_INTERRUPT (PENDING_INTERRUPTS ());
            }
            else
                POP_RETURN_ERROR (code);
        }
    }
    END_SUBPROBLEM ();
    break;

    case RC_EXECUTE_DEFINITION_FINISH:
    {
        SCHEME_OBJECT name = (MEMORY_REF (GET_EXP, DEFINE_NAME));
        SCHEME_OBJECT value = GET_VAL;
        long result;

        POP_ENV ();
        result = (define_variable (GET_ENV, name, value));
        if (result == PRIM_DONE)
        {
            END_SUBPROBLEM ();
            SET_VAL (name);
            break;
        }
        PUSH_ENV ();
        if (result == PRIM_INTERRUPT)
        {
            PREPARE_POP_RETURN_INTERRUPT (RC_EXECUTE_DEFINITION_FINISH,
                                          value);
            SIGNAL_INTERRUPT (PENDING_INTERRUPTS ());
        }
        SET_VAL (value);
        POP_RETURN_ERROR (result);
    }

    case RC_EXECUTE_IN_PACKAGE_CONTINUE:
        if (ENVIRONMENT_P (GET_VAL))
        {
            END_SUBPROBLEM ();
            SET_ENV (GET_VAL);
            REDUCES_TO_NTH (IN_PACKAGE_EXPRESSION);
        }
        POP_RETURN_ERROR (ERR_BAD_FRAME);

    case RC_HALT:
        Microcode_Termination (TERM_TERM_HANDLER);

    case RC_HARDWARE_TRAP:
    {
        /* This just reinvokes the handler */
        SCHEME_OBJECT info = (STACK_REF (0));
        SCHEME_OBJECT handler = SHARP_F;
        SAVE_CONT ();
        if (VECTOR_P (fixed_objects))
            handler = (VECTOR_REF (fixed_objects, TRAP_HANDLER));
        if (handler == SHARP_F)
        {
            outf_fatal ("There is no trap handler for recovery!\n");
            termination_trap ();
            /*NOTREACHED*/
        }
        Will_Push (STACK_ENV_EXTRA_SLOTS + 2);
        STACK_PUSH (info);
        STACK_PUSH (handler);
        PUSH_APPLY_FRAME_HEADER (1);
        Pushed ();
    }
    goto internal_apply;

    /* internal_apply, the core of the application mechanism.

    Branch here to perform a function application.

     At this point the top of the stack contains an application
     frame which consists of the following elements (see sdata.h):

     - A header specifying the frame length.
     - A procedure.
     - The actual (evaluated) arguments.

     No registers (except the stack pointer) are meaning full at
     this point.  Before interrupts or errors are processed, some
     registers are cleared to avoid holding onto garbage if a
     garbage collection occurs.  */

    case RC_INTERNAL_APPLY_VAL:
internal_apply_val:

        (APPLY_FRAME_PROCEDURE ()) = GET_VAL;

    case RC_INTERNAL_APPLY:
internal_apply:

#ifdef COMPILE_STEPPER
        if (trapping
                && (!WITHIN_CRITICAL_SECTION_P ())
                && ((FETCH_APPLY_TRAPPER ()) != SHARP_F))
        {
            unsigned long frame_size = (APPLY_FRAME_SIZE ());
            (* (STACK_LOC (0))) = (FETCH_APPLY_TRAPPER ());
            PUSH_APPLY_FRAME_HEADER (frame_size);
            trapping = false;
        }
#endif /* COMPILE_STEPPER */

Apply_Non_Trapping:
        if (PENDING_INTERRUPTS_P)
        {
            unsigned long interrupts = (PENDING_INTERRUPTS ());
            PREPARE_APPLY_INTERRUPT ();
            SIGNAL_INTERRUPT (interrupts);
        }

perform_application:
#ifdef APPLY_UCODE_HOOK
        APPLY_UCODE_HOOK ();
#endif
        {
            SCHEME_OBJECT Function = (APPLY_FRAME_PROCEDURE ());

apply_dispatch:
            switch (OBJECT_TYPE (Function))
            {
            case TC_ENTITY:
            {
                unsigned long frame_size = (APPLY_FRAME_SIZE ());
                SCHEME_OBJECT data = (MEMORY_REF (Function, ENTITY_DATA));
                if ((VECTOR_P (data))
                        && (frame_size < (VECTOR_LENGTH (data)))
                        && ((VECTOR_REF (data, frame_size)) != SHARP_F)
                        && ((VECTOR_REF (data, 0))
                            == (VECTOR_REF (fixed_objects, ARITY_DISPATCHER_TAG))))
                {
                    Function = (VECTOR_REF (data, frame_size));
                    (APPLY_FRAME_PROCEDURE ()) = Function;
                    goto apply_dispatch;
                }

                (STACK_REF (0)) = (MEMORY_REF (Function, ENTITY_OPERATOR));
                PUSH_APPLY_FRAME_HEADER (frame_size);
                /* This must be done to prevent an infinite push loop by
                an entity whose handler is the entity itself or some
                 other such loop.  Of course, it will die if stack overflow
                 interrupts are disabled.  */
                STACK_CHECK (0);
                goto internal_apply;
            }

            case TC_PROCEDURE:
            {
                unsigned long frame_size = (APPLY_FRAME_SIZE ());
                Function = (MEMORY_REF (Function, PROCEDURE_LAMBDA_EXPR));
                {
                    SCHEME_OBJECT formals
                        = (MEMORY_REF (Function, LAMBDA_FORMALS));

                    if ((frame_size != (VECTOR_LENGTH (formals)))
                            && (((OBJECT_TYPE (Function)) != TC_LEXPR)
                                || (frame_size < (VECTOR_LENGTH (formals)))))
                        APPLICATION_ERROR (ERR_WRONG_NUMBER_OF_ARGUMENTS);
                }
                if (GC_NEEDED_P (frame_size + 1))
                {
                    PREPARE_APPLY_INTERRUPT ();
                    IMMEDIATE_GC (frame_size + 1);
                }
                {
                    SCHEME_OBJECT * end = (Free + 1 + frame_size);
                    SCHEME_OBJECT env
                        = (MAKE_POINTER_OBJECT (TC_ENVIRONMENT, Free));
                    (*Free++) = (MAKE_OBJECT (TC_MANIFEST_VECTOR, frame_size));
                    (void) STACK_POP ();
                    while (Free < end)
                        (*Free++) = (STACK_POP ());
                    SET_ENV (env);
                    REDUCES_TO (MEMORY_REF (Function, LAMBDA_SCODE));
                }
            }

            case TC_CONTROL_POINT:
                if ((APPLY_FRAME_SIZE ()) != 2)
                    APPLICATION_ERROR (ERR_WRONG_NUMBER_OF_ARGUMENTS);
                SET_VAL (* (APPLY_FRAME_ARGS ()));
                unpack_control_point (Function);
                RESET_HISTORY ();
                goto pop_return;

            /* After checking the number of arguments, remove the
               frame header since primitives do not expect it.

               NOTE: This code must match the application code which
               follows primitive_internal_apply.  */

            case TC_PRIMITIVE:
                if (!IMPLEMENTED_PRIMITIVE_P (Function))
                    APPLICATION_ERROR (ERR_UNIMPLEMENTED_PRIMITIVE);
                {
                    unsigned long n_args = (APPLY_FRAME_N_ARGS ());


                    /* Note that the first test below will fail for lexpr
                    primitives.  */

                    if (n_args != (PRIMITIVE_ARITY (Function)))
                    {
                        if ((PRIMITIVE_ARITY (Function)) != LEXPR_PRIMITIVE_ARITY)
                            APPLICATION_ERROR (ERR_WRONG_NUMBER_OF_ARGUMENTS);
                        SET_LEXPR_ACTUALS (n_args);
                    }
                    stack_pointer = (APPLY_FRAME_ARGS ());
                    SET_EXP (Function);
                    APPLY_PRIMITIVE_FROM_INTERPRETER (Function);
                    POP_PRIMITIVE_FRAME (n_args);
                    goto pop_return;
                }

            case TC_EXTENDED_PROCEDURE:
            {
                SCHEME_OBJECT lambda;
                SCHEME_OBJECT temp;
                unsigned long nargs;
                unsigned long nparams;
                unsigned long formals;
                unsigned long params;
                unsigned long auxes;
                long rest_flag;
                long size;
                long i;
                SCHEME_OBJECT * scan;

                nargs = (POP_APPLY_FRAME_HEADER ());
                lambda = (MEMORY_REF (Function, PROCEDURE_LAMBDA_EXPR));
                Function = (MEMORY_REF (lambda, ELAMBDA_NAMES));
                nparams = ((VECTOR_LENGTH (Function)) - 1);
                Function = (Get_Count_Elambda (lambda));
                formals = (Elambda_Formals_Count (Function));
                params = ((Elambda_Opts_Count (Function)) + formals);
                rest_flag = (Elambda_Rest_Flag (Function));
                auxes = (nparams - (params + rest_flag));

                if ((nargs < formals) || (!rest_flag && (nargs > params)))
                {
                    PUSH_APPLY_FRAME_HEADER (nargs);
                    APPLICATION_ERROR (ERR_WRONG_NUMBER_OF_ARGUMENTS);
                }
                /* size includes the procedure slot, but not the header.  */
                size = (params + rest_flag + auxes + 1);
                if (GC_NEEDED_P
                        (size + 1
                         + ((nargs > params)
                            ? (2 * (nargs - params))
                            : 0)))
                {
                    PUSH_APPLY_FRAME_HEADER (nargs);
                    PREPARE_APPLY_INTERRUPT ();
                    IMMEDIATE_GC
                    (size + 1
                     + ((nargs > params)
                        ? (2 * (nargs - params))
                        : 0));
                }
                scan = Free;
                temp = (MAKE_POINTER_OBJECT (TC_ENVIRONMENT, scan));
                (*scan++) = (MAKE_OBJECT (TC_MANIFEST_VECTOR, size));
                if (nargs <= params)
                {
                    for (i = (nargs + 1); (--i) >= 0; )
                        (*scan++) = (STACK_POP ());
                    for (i = (params - nargs); (--i) >= 0; )
                        (*scan++) = DEFAULT_OBJECT;
                    if (rest_flag)
                        (*scan++) = EMPTY_LIST;
                    for (i = auxes; (--i) >= 0; )
                        (*scan++) = UNASSIGNED_OBJECT;
                }
                else
                {
                    /* rest_flag must be true. */
                    SCHEME_OBJECT list
                        = (MAKE_POINTER_OBJECT (TC_LIST, (scan + size)));
                    for (i = (params + 1); (--i) >= 0; )
                        (*scan++) = (STACK_POP ());
                    (*scan++) = list;
                    for (i = auxes; (--i) >= 0; )
                        (*scan++) = UNASSIGNED_OBJECT;
                    /* Now scan == OBJECT_ADDRESS (list) */
                    for (i = (nargs - params); (--i) >= 0; )
                    {
                        (*scan++) = (STACK_POP ());
                        (*scan) = MAKE_POINTER_OBJECT (TC_LIST, (scan + 1));
                        scan += 1;
                    }
                    (scan[-1]) = EMPTY_LIST;
                }

                Free = scan;
                SET_ENV (temp);
                REDUCES_TO (Get_Body_Elambda (lambda));
            }

#ifdef CC_SUPPORT_P
            case TC_COMPILED_ENTRY:
            {
                guarantee_cc_return (1 + (APPLY_FRAME_SIZE ()));
                dispatch_code = (apply_compiled_procedure ());

return_from_compiled_code:
                switch (dispatch_code)
                {
                case PRIM_DONE:
                    goto pop_return;

                case PRIM_APPLY:
                    goto internal_apply;

                case PRIM_INTERRUPT:
                    SIGNAL_INTERRUPT (PENDING_INTERRUPTS ());

                case PRIM_APPLY_INTERRUPT:
                    PREPARE_APPLY_INTERRUPT ();
                    SIGNAL_INTERRUPT (PENDING_INTERRUPTS ());

                case ERR_INAPPLICABLE_OBJECT:
                case ERR_WRONG_NUMBER_OF_ARGUMENTS:
                    APPLICATION_ERROR (dispatch_code);

                default:
                    Do_Micro_Error (dispatch_code, true);
                    goto internal_apply;
                }
            }
#endif

            default:
                APPLICATION_ERROR (ERR_INAPPLICABLE_OBJECT);
            }
        }

    case RC_JOIN_STACKLETS:
        unpack_control_point (GET_EXP);
        break;

    case RC_NORMAL_GC_DONE:
        SET_VAL (GET_EXP);
        /* Paranoia */
        if (GC_NEEDED_P (gc_space_needed))
            termination_gc_out_of_space ();
        gc_space_needed = 0;
        EXIT_CRITICAL_SECTION ({ SAVE_CONT (); });
        break;

    case RC_PCOMB1_APPLY:
        END_SUBPROBLEM ();
        PUSH_VAL ();		/* Argument value */
        Finished_Eventual_Pushing (CONTINUATION_SIZE + STACK_ENV_FIRST_ARG);
        SET_EXP (MEMORY_REF (GET_EXP, PCOMB1_FN_SLOT));

primitive_internal_apply:

#ifdef COMPILE_STEPPER
        if (trapping
                && (!WITHIN_CRITICAL_SECTION_P ())
                && ((FETCH_APPLY_TRAPPER ()) != SHARP_F))
        {
            Will_Push (3);
            PUSH_EXP ();
            STACK_PUSH (FETCH_APPLY_TRAPPER ());
            PUSH_APPLY_FRAME_HEADER (1 + (PRIMITIVE_N_PARAMETERS (GET_EXP)));
            Pushed ();
            trapping = false;
            goto Apply_Non_Trapping;
        }
#endif /* COMPILE_STEPPER */

        /* NOTE: This code must match the code in the TC_PRIMITIVE
        case of internal_apply.
         This code is simpler because:
         1) The arity was checked at syntax time.
         2) We don't have to deal with "lexpr" primitives.
         3) We don't need to worry about unimplemented primitives because
         unimplemented primitives will cause an error at invocation.  */
        {
            SCHEME_OBJECT primitive = GET_EXP;
            APPLY_PRIMITIVE_FROM_INTERPRETER (primitive);
            POP_PRIMITIVE_FRAME (PRIMITIVE_ARITY (primitive));
            break;
        }

    case RC_PCOMB2_APPLY:
        END_SUBPROBLEM ();
        PUSH_VAL ();		/* Value of arg. 1 */
        Finished_Eventual_Pushing (CONTINUATION_SIZE + STACK_ENV_FIRST_ARG);
        SET_EXP (MEMORY_REF (GET_EXP, PCOMB2_FN_SLOT));
        goto primitive_internal_apply;

    case RC_PCOMB2_DO_1:
        POP_ENV ();
        PUSH_VAL ();		/* Save value of arg. 2 */
        DO_ANOTHER_THEN (RC_PCOMB2_APPLY, PCOMB2_ARG_1_SLOT);

    case RC_PCOMB3_APPLY:
        END_SUBPROBLEM ();
        PUSH_VAL ();		/* Save value of arg. 1 */
        Finished_Eventual_Pushing (CONTINUATION_SIZE + STACK_ENV_FIRST_ARG);
        SET_EXP (MEMORY_REF (GET_EXP, PCOMB3_FN_SLOT));
        goto primitive_internal_apply;

    case RC_PCOMB3_DO_1:
    {
        SCHEME_OBJECT Temp = (STACK_POP ()); /* Value of arg. 3 */
        POP_ENV ();
        STACK_PUSH (Temp);	/* Save arg. 3 again */
        PUSH_VAL ();		/* Save arg. 2 */
        DO_ANOTHER_THEN (RC_PCOMB3_APPLY, PCOMB3_ARG_1_SLOT);
    }

    case RC_PCOMB3_DO_2:
        SET_ENV (STACK_REF (0));
        PUSH_VAL ();		/* Save value of arg. 3 */
        DO_ANOTHER_THEN (RC_PCOMB3_DO_1, PCOMB3_ARG_2_SLOT);

    case RC_POP_RETURN_ERROR:
    case RC_RESTORE_VALUE:
        SET_VAL (GET_EXP);
        break;

    /* The following two return codes are both used to restore a
    saved history object.  The difference is that the first does
     not copy the history object while the second does.  In both
     cases, the GET_EXP contains the history object and the
     next item to be popped off the stack contains the offset back
     to the previous restore history return code.  */

    case RC_RESTORE_DONT_COPY_HISTORY:
    {
        prev_restore_history_offset = (OBJECT_DATUM (STACK_POP ()));
        (void) STACK_POP ();
        history_register = (OBJECT_ADDRESS (GET_EXP));
        break;
    }

    case RC_RESTORE_HISTORY:
    {
        if (!restore_history (GET_EXP))
        {
            SAVE_CONT ();
            Will_Push (CONTINUATION_SIZE);
            SET_EXP (GET_VAL);
            SET_RC (RC_RESTORE_VALUE);
            SAVE_CONT ();
            Pushed ();
            IMMEDIATE_GC (HEAP_AVAILABLE);
        }
        prev_restore_history_offset = (OBJECT_DATUM (STACK_POP ()));
        (void) STACK_POP ();
        if (prev_restore_history_offset > 0)
            (STACK_LOCATIVE_REFERENCE (STACK_BOTTOM,
                                       (-prev_restore_history_offset)))
                = (MAKE_RETURN_CODE (RC_RESTORE_HISTORY));
        break;
    }

    case RC_RESTORE_INT_MASK:
        SET_INTERRUPT_MASK (UNSIGNED_FIXNUM_TO_LONG (GET_EXP));
        if (GC_NEEDED_P (0))
            REQUEST_GC (0);
        if (PENDING_INTERRUPTS_P)
        {
            SET_RC (RC_RESTORE_VALUE);
            SET_EXP (GET_VAL);
            SAVE_CONT ();
            SIGNAL_INTERRUPT (PENDING_INTERRUPTS ());
        }
        break;

    case RC_STACK_MARKER:
        /* Frame consists of the return code followed by two objects.
        The first object has already been popped into GET_EXP,
               so just pop the second argument.  */
        stack_pointer = (STACK_LOCATIVE_OFFSET (stack_pointer, 1));
        break;

    case RC_SEQ_2_DO_2:
        END_SUBPROBLEM ();
        POP_ENV ();
        REDUCES_TO_NTH (SEQUENCE_2);

    case RC_SEQ_3_DO_2:
        SET_ENV (STACK_REF (0));
        DO_ANOTHER_THEN (RC_SEQ_3_DO_3, SEQUENCE_2);

    case RC_SEQ_3_DO_3:
        END_SUBPROBLEM ();
        POP_ENV ();
        REDUCES_TO_NTH (SEQUENCE_3);

    case RC_SNAP_NEED_THUNK:
        /* Don't snap thunk twice; evaluation of the thunk's body might
        have snapped it already.  */
        if ((MEMORY_REF (GET_EXP, THUNK_SNAPPED)) == SHARP_T)
            SET_VAL (MEMORY_REF (GET_EXP, THUNK_VALUE));
        else
        {
            MEMORY_SET (GET_EXP, THUNK_SNAPPED, SHARP_T);
            MEMORY_SET (GET_EXP, THUNK_VALUE, GET_VAL);
        }
        break;

    default:
        POP_RETURN_ERROR (ERR_INAPPLICABLE_CONTINUATION);
    }
vtkDataArray *
avtZoneTypeExpression::DeriveVariable(vtkDataSet *in_ds, int currentDomainsIndex)
{
    vtkIdType ncells = in_ds->GetNumberOfCells();

    vtkIntArray *rv = vtkIntArray::New();
    rv->SetNumberOfComponents(4);
    rv->SetNumberOfTuples(ncells);
    for (vtkIdType i = 0 ; i < ncells ; i++)
    {
        char val[3];
        SET_VAL(" ? ");
        switch (in_ds->GetCellType(i))
        {
            // 2D cell types, lower case letters
            case VTK_EMPTY_CELL:     SET_VAL(emt); break;
            case VTK_VERTEX:         SET_VAL(vtx); break;
            case VTK_POLY_VERTEX:    SET_VAL(pvx); break;
            case VTK_LINE:           SET_VAL(lin); break;
            case VTK_POLY_LINE:      SET_VAL(pln); break;
            case VTK_TRIANGLE:       SET_VAL(tri); break;
            case VTK_TRIANGLE_STRIP: SET_VAL(tst); break;
            case VTK_POLYGON:        SET_VAL(ply); break;
            case VTK_PIXEL:          SET_VAL(pix); break;
            case VTK_QUAD:           SET_VAL(qad); break;

            // 3D cell types, upper case letters
            case VTK_TETRA:          SET_VAL(TET); break;
            case VTK_VOXEL:          SET_VAL(VOX); break;
            case VTK_HEXAHEDRON:     SET_VAL(HEX); break;
            case VTK_WEDGE:          SET_VAL(WDG); break;
            case VTK_PYRAMID:        SET_VAL(PYR); break;

            // Quadratic, isoparametric cells
            case VTK_QUADRATIC_EDGE:                   SET_VAL(Qln); break;
            case VTK_QUADRATIC_TRIANGLE:               SET_VAL(Qtr); break;
            case VTK_QUADRATIC_QUAD:                   SET_VAL(Qqd); break;
            case VTK_QUADRATIC_TETRA:                  SET_VAL(QTT); break;
            case VTK_QUADRATIC_HEXAHEDRON:             SET_VAL(QHX); break;
            case VTK_QUADRATIC_WEDGE:                  SET_VAL(QWD); break;
            case VTK_QUADRATIC_PYRAMID:                SET_VAL(QPY); break;
            case VTK_BIQUADRATIC_QUAD:                 SET_VAL(2Qq); break;
            case VTK_TRIQUADRATIC_HEXAHEDRON:          SET_VAL(3QH); break;
            case VTK_QUADRATIC_LINEAR_QUAD:            SET_VAL(QLq); break;
            case VTK_QUADRATIC_LINEAR_WEDGE:           SET_VAL(QLW); break;
            case VTK_BIQUADRATIC_QUADRATIC_WEDGE:      SET_VAL(2QW); break;
            case VTK_BIQUADRATIC_QUADRATIC_HEXAHEDRON: SET_VAL(3QH); break;
            case VTK_BIQUADRATIC_TRIANGLE:             SET_VAL(2Qt); break;

            case VTK_CUBIC_LINE:       SET_VAL(3ln); break;
            case VTK_CONVEX_POINT_SET: SET_VAL(CPS); break;
            case VTK_POLYHEDRON:       SET_VAL(PLY); break;

            // Higher order cells in parametric form
            case VTK_PARAMETRIC_CURVE:        SET_VAL(Pcu); break;
            case VTK_PARAMETRIC_SURFACE:      SET_VAL(Psu); break;
            case VTK_PARAMETRIC_TRI_SURFACE:  SET_VAL(Pts); break;
            case VTK_PARAMETRIC_QUAD_SURFACE: SET_VAL(Pqs); break;
            case VTK_PARAMETRIC_TETRA_REGION: SET_VAL(PTR); break;
            case VTK_PARAMETRIC_HEX_REGION:   SET_VAL(PHR); break;

            // Higher order cells
            case VTK_HIGHER_ORDER_EDGE:        SET_VAL(HOl); break;
            case VTK_HIGHER_ORDER_TRIANGLE:    SET_VAL(HOt); break;
            case VTK_HIGHER_ORDER_QUAD:        SET_VAL(HOq); break;
            case VTK_HIGHER_ORDER_POLYGON:     SET_VAL(HOp); break;
            case VTK_HIGHER_ORDER_TETRAHEDRON: SET_VAL(HOT); break;
            case VTK_HIGHER_ORDER_WEDGE:       SET_VAL(HOW); break;
            case VTK_HIGHER_ORDER_PYRAMID:     SET_VAL(HOP); break;
            case VTK_HIGHER_ORDER_HEXAHEDRON:  SET_VAL(HOH); break;
        }            

        rv->SetTuple4(i, (int) val[0], (int) val[1], (int) val[2], (int) '\0');
    }

    return rv;
}
Beispiel #23
0
static void xgene_cle_dn_to_hw(struct xgene_cle_ptree_ewdn *dn,
			       u32 *buf, u32 jb)
{
	struct xgene_cle_ptree_branch *br;
	u32 i, j = 0;
	u32 npp;

	buf[j++] = SET_VAL(CLE_DN_TYPE, dn->node_type) |
		   SET_VAL(CLE_DN_LASTN, dn->last_node) |
		   SET_VAL(CLE_DN_HLS, dn->hdr_len_store) |
		   SET_VAL(CLE_DN_EXT, dn->hdr_extn) |
		   SET_VAL(CLE_DN_BSTOR, dn->byte_store) |
		   SET_VAL(CLE_DN_SBSTOR, dn->search_byte_store) |
		   SET_VAL(CLE_DN_RPTR, dn->result_pointer);

	for (i = 0; i < dn->num_branches; i++) {
		br = &dn->branch[i];
		npp = br->next_packet_pointer;

		if ((br->jump_rel == JMP_ABS) && (npp < CLE_PKTRAM_SIZE))
			npp += jb;

		buf[j++] = SET_VAL(CLE_BR_VALID, br->valid) |
			   SET_VAL(CLE_BR_NPPTR, npp) |
			   SET_VAL(CLE_BR_JB, br->jump_bw) |
			   SET_VAL(CLE_BR_JR, br->jump_rel) |
			   SET_VAL(CLE_BR_OP, br->operation) |
			   SET_VAL(CLE_BR_NNODE, br->next_node) |
			   SET_VAL(CLE_BR_NBR, br->next_branch);

		buf[j++] = SET_VAL(CLE_BR_DATA, br->data) |
			   SET_VAL(CLE_BR_MASK, br->mask);
	}
}
Beispiel #24
0
}

static void xgene_xgmac_set_mss(struct xgene_enet_pdata *pdata,
				u16 mss, u8 index)
{
	u8 offset;
	u32 data;

	offset = (index < 2) ? 0 : 4;
	xgene_enet_rd_csr(pdata, XG_TSIF_MSS_REG0_ADDR + offset, &data);

	if (!(index & 0x1))
		data = SET_VAL(TSO_MSS1, data >> TSO_MSS1_POS) |
			SET_VAL(TSO_MSS0, mss);
	else
		data = SET_VAL(TSO_MSS1, mss) | SET_VAL(TSO_MSS0, data);

	xgene_enet_wr_csr(pdata, XG_TSIF_MSS_REG0_ADDR + offset, data);
}

static void xgene_xgmac_set_frame_size(struct xgene_enet_pdata *pdata, int size)
{
	xgene_enet_wr_mac(pdata, HSTMAXFRAME_LENGTH_ADDR,
			  ((((size + 2) >> 2) << 16) | size));
}

static u32 xgene_enet_link_status(struct xgene_enet_pdata *pdata)
{
	u32 data;

	xgene_enet_rd_csr(pdata, XG_LINK_STATUS_ADDR, &data);