1 // SPDX-License-Identifier: GPL-2.0+ 2 /* 3 * (C) Copyright 2014 4 * Heiko Schocher, DENX Software Engineering, hs (at) denx.de. 5 * 6 * Basic support for the pwm module on imx6. 7 */ 8 9 #include <common.h> 10 #include <div64.h> 11 #include <pwm.h> 12 #include <asm/arch/imx-regs.h> 13 #include <asm/io.h> 14 #include "pwm-imx-util.h" 15 16 int pwm_init(int pwm_id, int div, int invert) 17 { 18 struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id); 19 20 if (!pwm) 21 return -1; 22 23 writel(0, &pwm->ir); 24 return 0; 25 } 26 27 int pwm_config(int pwm_id, int duty_ns, int period_ns) 28 { 29 struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id); 30 unsigned long period_cycles, duty_cycles, prescale; 31 u32 cr; 32 33 if (!pwm) 34 return -1; 35 36 pwm_imx_get_parms(period_ns, duty_ns, &period_cycles, &duty_cycles, 37 &prescale); 38 39 cr = PWMCR_PRESCALER(prescale) | 40 PWMCR_DOZEEN | PWMCR_WAITEN | 41 PWMCR_DBGEN | PWMCR_CLKSRC_IPG_HIGH; 42 43 writel(cr, &pwm->cr); 44 /* set duty cycles */ 45 writel(duty_cycles, &pwm->sar); 46 /* set period cycles */ 47 writel(period_cycles, &pwm->pr); 48 return 0; 49 } 50 51 int pwm_enable(int pwm_id) 52 { 53 struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id); 54 55 if (!pwm) 56 return -1; 57 58 setbits_le32(&pwm->cr, PWMCR_EN); 59 return 0; 60 } 61 62 void pwm_disable(int pwm_id) 63 { 64 struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id); 65 66 if (!pwm) 67 return; 68 69 clrbits_le32(&pwm->cr, PWMCR_EN); 70 } 71