Ejemplo n.º 1
0
static unsigned int s3c24xx_serial_getclk(struct uart_port *port,
					  struct s3c24xx_uart_clksrc **clksrc,
					  struct clk **clk,
					  unsigned int baud)
{
	struct s3c2410_uartcfg *cfg = s3c24xx_port_to_cfg(port);
	struct s3c24xx_uart_clksrc *clkp;
	struct baud_calc res[MAX_CLKS];
	struct baud_calc *resptr, *best, *sptr;
	int i;

	clkp = cfg->clocks;
	best = NULL;

	if (cfg->clocks_size < 2) {
		if (cfg->clocks_size == 0)
			clkp = &tmp_clksrc;

		s3c24xx_serial_calcbaud(res, port, clkp, baud);
		best = res;
		resptr = best + 1;
	} else {
		resptr = res;

		for (i = 0; i < cfg->clocks_size; i++, clkp++) {
			if (s3c24xx_serial_calcbaud(resptr, port, clkp, baud))
				resptr++;
		}
	}

	/* ok, we now need to select the best clock we found */

	if (!best) {
		unsigned int deviation = (1<<30)|((1<<30)-1);
		int calc_deviation;

		for (sptr = res; sptr < resptr; sptr++) {
			printk(KERN_DEBUG
			       "found clk %p (%s) quot %d, calc %d\n",
			       sptr->clksrc, sptr->clksrc->name,
			       sptr->quot, sptr->calc);

			calc_deviation = baud - sptr->calc;
			if (calc_deviation < 0)
				calc_deviation = -calc_deviation;

			if (calc_deviation < deviation) {
				best = sptr;
				deviation = calc_deviation;
			}
		}

		printk(KERN_DEBUG "best %p (deviation %d)\n", best, deviation);
	}

	printk(KERN_DEBUG "selected clock %p (%s) quot %d, calc %d\n",
	       best->clksrc, best->clksrc->name, best->quot, best->calc);

	/* store results to pass back */

	*clksrc = best->clksrc;
	*clk    = best->src;

	return best->quot;
}
Ejemplo n.º 2
0
static unsigned int s3c24xx_serial_getclk(struct uart_port *port,
        struct s3c24xx_uart_clksrc **clksrc,
        struct clk **clk,
        unsigned int baud)
{
    struct s3c2410_uartcfg *cfg = s3c24xx_port_to_cfg(port);
    struct s3c24xx_uart_clksrc *clkp;
    struct baud_calc res[MAX_CLKS];
    struct baud_calc *resptr, *best, *sptr;
    int i;

    clkp = cfg->clocks;
    best = NULL;

    if (cfg->clocks_size < 2) {
        if (cfg->clocks_size == 0)
            clkp = &tmp_clksrc;

        /* check to see if we're sourcing fclk, and if so we're
         * going to have to update the clock source
         */

        if (strcmp(clkp->name, "fclk") == 0) {
            struct s3c24xx_uart_clksrc src;

            s3c24xx_serial_getsource(port, &src);

            /* check that the port already using fclk, and if
             * not, then re-select fclk
             */

            if (strcmp(src.name, clkp->name) == 0) {
                s3c24xx_serial_setsource(port, clkp);
                s3c24xx_serial_getsource(port, &src);
            }

            clkp->divisor = src.divisor;
        }

        s3c24xx_serial_calcbaud(res, port, clkp, baud);
        best = res;
        resptr = best + 1;
    } else {
        resptr = res;

        for (i = 0; i < cfg->clocks_size; i++, clkp++) {
            if (s3c24xx_serial_calcbaud(resptr, port, clkp, baud))
                resptr++;
        }
    }

    /* ok, we now need to select the best clock we found */

    if (!best) {
        unsigned int deviation = (1<<30)|((1<<30)-1);
        int calc_deviation;

        for (sptr = res; sptr < resptr; sptr++) {
            calc_deviation = baud - sptr->calc;
            if (calc_deviation < 0)
                calc_deviation = -calc_deviation;

            if (calc_deviation < deviation) {
                best = sptr;
                deviation = calc_deviation;
            }
        }
    }

    /* store results to pass back */

    *clksrc = best->clksrc;
    *clk    = best->src;

    return best->quot;
}
Ejemplo n.º 3
0
static unsigned int s3c24xx_serial_getclk(struct uart_port *port,
					  struct s3c24xx_uart_clksrc **clksrc,
					  struct clk **clk,
					  unsigned int baud)
{
	struct s3c2410_uartcfg *cfg = s3c24xx_port_to_cfg(port);
	struct s3c24xx_uart_clksrc *clkp;
	struct baud_calc res[MAX_CLKS];
	struct baud_calc *resptr, *best, *sptr;
	int i;

	clkp = cfg->clocks;
	best = NULL;

	if (cfg->clocks_size < 2) {
		if (cfg->clocks_size == 0)
			clkp = &tmp_clksrc;

		

		if (strcmp(clkp->name, "fclk") == 0) {
			struct s3c24xx_uart_clksrc src;

			s3c24xx_serial_getsource(port, &src);

			

			if (strcmp(src.name, clkp->name) == 0) {
				s3c24xx_serial_setsource(port, clkp);
				s3c24xx_serial_getsource(port, &src);
			}

			clkp->divisor = src.divisor;
		}

		s3c24xx_serial_calcbaud(res, port, clkp, baud);
		best = res;
		resptr = best + 1;
	} else {
		resptr = res;

		for (i = 0; i < cfg->clocks_size; i++, clkp++) {
			if (s3c24xx_serial_calcbaud(resptr, port, clkp, baud))
				resptr++;
		}
	}

	

	if (!best) {
		unsigned int deviation = (1<<30)|((1<<30)-1);
		int calc_deviation;

		for (sptr = res; sptr < resptr; sptr++) {
			calc_deviation = baud - sptr->calc;
			if (calc_deviation < 0)
				calc_deviation = -calc_deviation;

			if (calc_deviation < deviation) {
				best = sptr;
				deviation = calc_deviation;
			}
		}
	}

	

	*clksrc = best->clksrc;
	*clk    = best->src;

	return best->quot;
}