int pwm_init(int pwm_id, int div, int invert) { u32 val; const struct s5p_timer *pwm = (struct s5p_timer *)samsung_get_base_timer(); unsigned long ticks_per_period; unsigned int offset, prescaler; /* * Timer Freq(HZ) = * PWM_CLK / { (prescaler_value + 1) * (divider_value) } */ val = readl(&pwm->tcfg0); if (pwm_id < 2) { prescaler = PRESCALER_0; val &= ~0xff; val |= (prescaler & 0xff); } else { prescaler = PRESCALER_1; val &= ~(0xff << 8); val |= (prescaler & 0xff) << 8; } writel(val, &pwm->tcfg0); val = readl(&pwm->tcfg1); val &= ~(0xf << MUX_DIV_SHIFT(pwm_id)); val |= (div & 0xf) << MUX_DIV_SHIFT(pwm_id); writel(val, &pwm->tcfg1); if (pwm_id == 4) { /* * TODO(sjg): Use this as a countdown timer for now. We count * down from the maximum value to 0, then reset. */ ticks_per_period = -1UL; } else { const unsigned long pwm_hz = 1000; unsigned long timer_rate_hz = clock_get_periph_rate( PERIPH_ID_PWM0) / ((prescaler + 1) * (1 << div)); ticks_per_period = timer_rate_hz / pwm_hz; } /* set count value */ offset = pwm_id * 3; writel(ticks_per_period, &pwm->tcntb0 + offset); val = readl(&pwm->tcon) & ~(0xf << TCON_OFFSET(pwm_id)); if (invert && (pwm_id < 4)) val |= TCON_INVERTER(pwm_id); writel(val, &pwm->tcon); pwm_enable(pwm_id); return 0; }
int pwm_init(int pwm_id, int div, int invert) { u32 val; const struct s5p_timer *pwm = (struct s5p_timer *)samsung_get_base_timer(); unsigned long timer_rate_hz; unsigned int offset, prescaler; /* * Timer Freq(HZ) = * PWM_CLK / { (prescaler_value + 1) * (divider_value) } */ val = readl(&pwm->tcfg0); if (pwm_id < 2) { prescaler = PRESCALER_0; val &= ~0xff; val |= (prescaler & 0xff); } else { prescaler = PRESCALER_1; val &= ~(0xff << 8); val |= (prescaler & 0xff) << 8; } writel(val, &pwm->tcfg0); val = readl(&pwm->tcfg1); val &= ~(0xf << MUX_DIV_SHIFT(pwm_id)); val |= (div & 0xf) << MUX_DIV_SHIFT(pwm_id); writel(val, &pwm->tcfg1); #if defined(CONFIG_CPU_EXYNOS5410) timer_rate_hz = 2500000; #elif defined(CONFIG_CPU_EXYNOS5420) timer_rate_hz = 1800000; #else timer_rate_hz = get_pwm_clk() / ((prescaler + 1) * (div + 1)); #endif timer_rate_hz = timer_rate_hz / 100; /* set count value */ offset = pwm_id * 3; timer_rate_hz = -1; writel(timer_rate_hz, &pwm->tcntb0 + offset); val = readl(&pwm->tcon) & ~(0xf << TCON_OFFSET(pwm_id)); if (invert && (pwm_id < 4)) val |= TCON_INVERTER(pwm_id); writel(val, &pwm->tcon); pwm_enable(pwm_id); return 0; }