linux-imx

/*

 * Copyright (C) 2014 Free Electrons

 * Copyright (C) 2014 Atmel

 *

 * Author: Boris BREZILLON <boris.brezillon@free-electrons.com>

 *

 * This program is free software; you can redistribute it and/or modify it

 * under the terms of the GNU General Public License version 2 as published by

 * the Free Software Foundation.

 *

 * This program is distributed in the hope that it will be useful, but WITHOUT

 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or

 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for

 * more details.

 *

 * You should have received a copy of the GNU General Public License along with

 * this program.  If not, see <http://www.gnu.org/licenses/>.

 */

​

#include <linux/clk.h>

#include <linux/delay.h>

#include <linux/mfd/atmel-hlcdc.h>

#include <linux/module.h>

#include <linux/platform_device.h>

#include <linux/pwm.h>

#include <linux/regmap.h>

​

#define ATMEL_HLCDC_PWMCVAL_MASK    GENMASK(15, 8)

#define ATMEL_HLCDC_PWMCVAL(x)      (((x) << 8) & ATMEL_HLCDC_PWMCVAL_MASK)

#define ATMEL_HLCDC_PWMPOL      BIT(4)

#define ATMEL_HLCDC_PWMPS_MASK      GENMASK(2, 0)

#define ATMEL_HLCDC_PWMPS_MAX       0x6

#define ATMEL_HLCDC_PWMPS(x)        ((x) & ATMEL_HLCDC_PWMPS_MASK)

​

struct atmel_hlcdc_pwm_errata {

    bool slow_clk_erratum;

    bool div1_clk_erratum;

};

​

struct atmel_hlcdc_pwm {

    struct pwm_chip chip;

    struct atmel_hlcdc *hlcdc;

    struct clk *cur_clk;

    const struct atmel_hlcdc_pwm_errata *errata;

};

​

static inline struct atmel_hlcdc_pwm *to_atmel_hlcdc_pwm(struct pwm_chip *chip)

{

    return container_of(chip, struct atmel_hlcdc_pwm, chip);

}

​

static int atmel_hlcdc_pwm_apply(struct pwm_chip *c, struct pwm_device *pwm,

                 struct pwm_state *state)

{

    struct atmel_hlcdc_pwm *chip = to_atmel_hlcdc_pwm(c);

    struct atmel_hlcdc *hlcdc = chip->hlcdc;

    unsigned int status;

    int ret;

​

    if (state->enabled) {

        struct clk *new_clk = hlcdc->slow_clk;

        u64 pwmcval = state->duty_cycle * 256;

        unsigned long clk_freq;