Ejemplo n.º 1
0
int main(int argc, char *argv[])
{
    unsigned int off, val, hw_resv, sw_resv, cpu_clk;
    unsigned int sch, sch_en, sch_rate, weight;
    unsigned int min_en, min_rate, max_en, max_rate, exp, man;

    qdma_init();

    if (argc < 2)
        usage(argv[0]);
    else if (!strncmp(argv[1], "resv", 5)) {
        printf("resv\n");

        if (argc < 5)
            usage(argv[0]);

        off = strtoul(argv[2], NULL, 10)* 0x10;
        hw_resv = strtoul(argv[3], NULL, 10);
        sw_resv = strtoul(argv[4], NULL, 10);
        val = (hw_resv << 8) | sw_resv;
        if (off > 0xf0 || val > 0xffff)
            usage(argv[0]);
        //val = (hw_resv << 8) | sw_resv;
        reg_write(off, val);
        printf("set offset %x as %x for reservation.\n", off, val);
    }
    else if (!strncmp(argv[1], "sch", 4)) {
        printf("sch\n");
        if (argc < 4)
            usage(argv[0]);
        off = strtoul(argv[2], NULL, 10)* 0x10 + 0x04;
        sch = strtoul(argv[3], NULL, 10);
        if (off > 0xf4 || sch > 1)
            usage(argv[0]);
        reg_read(off, &val);
        val =(val & 0x7fffffff) | (sch << 31);
        reg_write(off, val);
        printf("set offset %x as %x for sch selection.\n", off, val);
    }
    else if (!strncmp(argv[1], "weight", 7)) {
        printf("weight\n");
        if (argc < 4)
            usage(argv[0]);
        off = strtoul(argv[2], NULL, 10)* 0x10 + 0x04;
        weight = strtoul(argv[3], NULL, 10);
        if (off > 0xf4 || weight > 0xf)
            usage(argv[0]);
        reg_read(off, &val);
        val = (val & 0xffff0fff) | (weight << 12);
        reg_write(off, val);
        printf("set offset %x as %x for max rate weight.\n", off, val);
    }
    else if (!strncmp(argv[1], "rate", 5)) {
        printf("rate\n");
#if defined (CONFIG_RALINK_MT7621)
        read_cpu_clk(off, &val);
        cpu_clk = val;
#endif
        if (argc < 7)
            usage(argv[0]);
        off = strtoul(argv[2], NULL, 10)* 0x10 + 0x04;
        min_en = strtoul(argv[3], NULL, 10);
        min_rate = strtoul(argv[4], NULL, 10);
        max_rate = strtoul(argv[6], NULL, 10);
        max_en = strtoul(argv[5], NULL, 10);
        if (off > 0xf4 || (min_en > 1) || (max_en > 1)|| min_rate > 1000000 || max_rate > 1000000 )
            usage(argv[0]);
        /* only for MT7621 E1 and E2, not needed in E3 and after */
#if 0
#if defined (CONFIG_RALINK_MT7621)
        min_rate = min_rate * 125 / cpu_clk;
        max_rate = max_rate * 125 / cpu_clk;
#endif
        if (min_rate > 127) {
            if ( min_rate % 10)
                min_rate = (min_rate / 10 + 1) << 4 | 0x04;
            else
                min_rate = (min_rate / 10) << 4 | 0x04;
        } else
            min_rate = min_rate << 4 | 0x03;

        if (max_rate > 127) {
            if ( max_rate % 10)
                max_rate = (max_rate / 10 + 1) << 4 | 0x04;
            else
                max_rate = (max_rate / 10) << 4 | 0x04;
        } else
            max_rate = max_rate << 4 | 0x03;
#endif
        if (min_rate > 127000) {
            exp = 0x04;
            man = rate_convert(min_rate / 1000 );
        } else if (min_rate > 12700) {
            exp = 0x03;
            man = rate_convert(min_rate / 100);
        } else if (min_rate > 1270) {
            exp = 0x02;
            man = rate_convert(min_rate / 10);
        } else if (min_rate > 127) {
            exp = 0x01;
            man = rate_convert(min_rate);
        } else {
            exp = 0x00;
            man = min_rate;
        }
        min_rate = man << 4 | exp;

        if (max_rate > 127000) {
            exp = 0x04;
            man = rate_convert(max_rate / 1000);
        } else if (max_rate > 12700) {
            exp = 0x03;
            man = rate_convert(max_rate / 100);
        } else if (max_rate > 1270) {
            exp = 0x02;
            man = rate_convert(max_rate / 10);
        } else if (max_rate > 127) {
            exp = 0x01;
            man = rate_convert(max_rate);
        } else {
            exp = 0x00;
            man = max_rate;
        }
        max_rate = man << 4 | exp;

        reg_read(off, &val);
        val = (val&0xf000f000) | (min_en <<27) | (min_rate<<16) | (max_en<<11) | (max_rate);
        reg_write(off, val);
        printf("set offset %x as %x for rate control.\n", off, val);
    }
    else if (!strncmp(argv[1], "sch_rate", 9)) {
#if defined (CONFIG_RALINK_MT7621)
        read_cpu_clk(off, &val);
        cpu_clk = val;
#endif
        if (argc < 5)
            usage(argv[0]);
        off = 0x214;
        sch = strtoul(argv[2], NULL, 10);
        sch_en = strtoul(argv[3], NULL, 10);
        sch_rate = strtoul(argv[4], NULL, 10);
        if ( (sch > 1 ) || (sch_en > 1) || (sch_rate > 1000000))
            usage(argv[0]);
        /* only for MT7621 E1 and E2, not needed in E3 and after */
#if 0
#if defined (CONFIG_RALINK_MT7621)
        sch_rate =  sch_rate * 125 / cpu_clk;
#endif
        if (sch_rate > 127) {
            if ( sch_rate % 10)
                sch_rate = (sch_rate / 10 + 1) << 4 | 0x04;
            else
                sch_rate = (sch_rate / 10) << 4 | 0x04;
        } else
            sch_rate = sch_rate << 4 | 0x03;
#endif
        if (sch_rate > 127000) {
            exp = 0x04;
            man = rate_convert(sch_rate / 1000 );
        } else if (sch_rate > 12700) {
            exp = 0x03;
            man = rate_convert(sch_rate / 100);
        } else if (sch_rate > 1270) {
            exp = 0x02;
            man = rate_convert(sch_rate / 10);
        } else if (sch_rate > 127) {
            exp = 0x01;
            man = rate_convert(sch_rate);
        } else {
            exp = 0x00;
            man = sch_rate;
        }
        sch_rate = man << 4 | exp;

        reg_read(off, &val);
        if (sch == 1)
            val = (val&0xffff) | (sch_en << 27) | (sch_rate <<16);
        else
            val = (val&0xffff0000) | (sch_en << 11) | (sch_rate);
        reg_write(off, val);
        printf("set offset %x as %x for sch rate control.\n", off, val);
    }
    else if (!strncmp(argv[1], "m2q", 4)) {
        int mark, queue;
        mark = strtoul(argv[2], NULL, 10);
        queue = strtoul(argv[3], NULL, 10);
        if (mark > 63 || queue > 15)
            usage(argv[0]);
        queue_mapping(mark, queue);
        printf("set queue mapping: skb with mark %x to queue %d.\n",mark, queue);
    }
    else
        usage(argv[0]);

    qdma_fini();
    return 0;
}
Ejemplo n.º 2
0
int main(int argc, char *argv[])
{
	unsigned int off, val, hw_resv, sw_resv;
	unsigned int sch, sch_en, sch_rate, weight;
	unsigned int min_en, min_rate, max_en, max_rate, exp, man;

	qdma_init();

	if (argc < 2)
		usage(argv[0]);
	else if (!strncmp(argv[1], "resv", 5)) {
		printf("resv\n");
		
		if (argc < 5)
			usage(argv[0]);
		
		off = strtoul(argv[2], NULL, 10)* 0x10;
		hw_resv = strtoul(argv[3], NULL, 10);
		sw_resv = strtoul(argv[4], NULL, 10);
		val = (hw_resv << 8) | sw_resv;
		if (off > 0xf0 || val > 0xffff)
			usage(argv[0]);
		//val = (hw_resv << 8) | sw_resv;
		reg_write(off, val);
		printf("set offset %x as %x for reservation.\n", off, val);
	}
	else if (!strncmp(argv[1], "sch", 4)) {
		printf("sch\n");
		if (argc < 4)
			usage(argv[0]);
		off = strtoul(argv[2], NULL, 10)* 0x10 + 0x04;
		sch = strtoul(argv[3], NULL, 10);
		if (off > 0xf4 || sch > 1)
			usage(argv[0]);
		reg_read(off, &val);
		val =(val & 0x7fffffff) | (sch << 31);
		reg_write(off, val);
		printf("set offset %x as %x for sch selection.\n", off, val);
	}
	else if (!strncmp(argv[1], "weight", 7)) {
		printf("weight\n");
		if (argc < 4)
			usage(argv[0]);
		off = strtoul(argv[2], NULL, 10)* 0x10 + 0x04;
		weight = strtoul(argv[3], NULL, 10);
		if (off > 0xf4 || weight > 0xf)
			usage(argv[0]);
		reg_read(off, &val);
		val = (val & 0xffff0fff) | (weight << 12);
		reg_write(off, val);
		printf("set offset %x as %x for max rate weight.\n", off, val);
	}
	else if (!strncmp(argv[1], "rate", 5)) {
		printf("rate\n");
		if (argc < 7)
			usage(argv[0]);
		off = strtoul(argv[2], NULL, 10)* 0x10 + 0x04;
		min_en = strtoul(argv[3], NULL, 10);
		min_rate = strtoul(argv[4], NULL, 10);
		max_rate = strtoul(argv[6], NULL, 10);
		max_en = strtoul(argv[5], NULL, 10);
		if (off > 0xf4 || (min_en > 1) || (max_en > 1)|| min_rate > 1000000 || max_rate > 1000000)
			usage(argv[0]);
		if (min_rate > 127000){
			exp = 0x04;
			man = rate_convert(min_rate / 1000 );
		}else if (min_rate > 12700){
			exp = 0x03;
			man = rate_convert(min_rate / 100);
		}else if (min_rate > 1270){
			exp = 0x02;
			man = rate_convert(min_rate / 10);
		}else if (min_rate > 127){
			exp = 0x01;
			man = rate_convert(min_rate);
		}else{
			exp = 0x00;
			man = min_rate;
		}
		min_rate = (man << 4) | exp;
		
		if (max_rate > 127000){
			exp = 0x04;
			man = rate_convert(max_rate / 1000);
		}else if (max_rate > 12700){
			exp = 0x03;
			man = rate_convert(max_rate / 100);
		}else if (max_rate > 1270){
			exp = 0x02;
			man = rate_convert(max_rate / 10);
		}else if (max_rate > 127){
			exp = 0x01;
			man = rate_convert(max_rate);
		}else{
			exp = 0x00;
			man = max_rate;
		}
		max_rate = (man << 4) | exp;
		
		reg_read(off, &val);
		val = (val&0xf000f000) | (min_en <<27) | (min_rate<<16) | (max_en<<11) | (max_rate);
		reg_write(off, val);
		printf("set offset %x as %x for rate control.\n", off, val);
	}
	else if (!strncmp(argv[1], "sch_rate", 9)) {
		if (argc < 5)
			usage(argv[0]);
		off = 0x214;
		sch = strtoul(argv[2], NULL, 10);
		sch_en = strtoul(argv[3], NULL, 10);
		sch_rate = strtoul(argv[4], NULL, 10);
		if ((sch > 1 ) || (sch_en > 1) || (sch_rate > 1000000))
			usage(argv[0]);
		if (sch_rate > 127000){
			exp = 0x04;
			man = rate_convert(sch_rate / 1000 );
		}else if (sch_rate > 12700){
			exp = 0x03;
			man = rate_convert(sch_rate / 100);
		}else if (sch_rate > 1270){
			exp = 0x02;
			man = rate_convert(sch_rate / 10);
		}else if (sch_rate > 127){
			exp = 0x01;
			man = rate_convert(sch_rate);
		}else{
			exp = 0x00;
			man = sch_rate;
		}
		sch_rate = (man << 4) | exp;
		
		reg_read(off, &val);
		if (sch == 1)
			val = (val&0xffff) | (sch_en << 27) | (sch_rate <<16);
		else
			val = (val&0xffff0000) | (sch_en << 11) | (sch_rate);
		reg_write(off, val);
		printf("set offset %x as %x for sch rate control.\n", off, val);
	}
	else if (!strncmp(argv[1], "m2q", 4)) {
		int mark, queue;
		mark = strtoul(argv[2], NULL, 10);
		queue = strtoul(argv[3], NULL, 10);
		if (mark > 63 || queue > 15)
			usage(argv[0]);
		/* Separate LAN/WAN packet with the same mark value */
		if (argc > 4 && strtoul(argv[4], NULL, 10) != 0)
			mark |= 0x100;
		queue_mapping(mark, queue);
		printf("set queue mapping: skb with mark %x to queue %d.\n",mark, queue);
	}
	else
		usage(argv[0]);

	qdma_fini();
	return 0;
}