|
@@ -111,6 +111,7 @@ static int s3c24xx_spi_setupxfer(struct spi_device *spi,
|
|
|
unsigned int bpw;
|
|
|
unsigned int hz;
|
|
|
unsigned int div;
|
|
|
+ unsigned long clk;
|
|
|
|
|
|
bpw = t ? t->bits_per_word : spi->bits_per_word;
|
|
|
hz = t ? t->speed_hz : spi->max_speed_hz;
|
|
@@ -120,20 +121,16 @@ static int s3c24xx_spi_setupxfer(struct spi_device *spi,
|
|
|
return -EINVAL;
|
|
|
}
|
|
|
|
|
|
- div = clk_get_rate(hw->clk) / hz;
|
|
|
-
|
|
|
- /* is clk = pclk / (2 * (pre+1)), or is it
|
|
|
- * clk = (pclk * 2) / ( pre + 1) */
|
|
|
-
|
|
|
- div /= 2;
|
|
|
-
|
|
|
- if (div > 0)
|
|
|
- div -= 1;
|
|
|
+ clk = clk_get_rate(hw->clk);
|
|
|
+ div = DIV_ROUND_UP(clk, hz * 2) - 1;
|
|
|
|
|
|
if (div > 255)
|
|
|
div = 255;
|
|
|
|
|
|
- dev_dbg(&spi->dev, "setting pre-scaler to %d (hz %d)\n", div, hz);
|
|
|
+ dev_dbg(&spi->dev, "setting pre-scaler to %d (wanted %d, got %ld)\n",
|
|
|
+ div, hz, clk / (2 * (div + 1)));
|
|
|
+
|
|
|
+
|
|
|
writeb(div, hw->regs + S3C2410_SPPRE);
|
|
|
|
|
|
spin_lock(&hw->bitbang.lock);
|