uboot-phytec

// SPDX-License-Identifier: GPL-2.0+ OR BSD-3-Clause

/*

 * Copyright (C) 2018, STMicroelectronics - All Rights Reserved

 * Author: Christophe Kerello <christophe.kerello@st.com>

 */

​

#include <common.h>

#include <dm.h>

#include <errno.h>

#include <power/pmic.h>

#include <power/regulator.h>

#include <power/stpmic1.h>

​

struct stpmic1_range {

    int min_uv;

    int min_sel;

    int max_sel;

    int step;

};

​

struct stpmic1_output {

    const struct stpmic1_range *ranges;

    int nbranges;

};

​

#define STPMIC1_MODE(_id, _val, _name) { \

    .id = _id,          \

    .register_value = _val,     \

    .name = _name,          \

}

​

#define STPMIC1_RANGE(_min_uv, _min_sel, _max_sel, _step) { \

    .min_uv = _min_uv,      \

    .min_sel = _min_sel,        \

    .max_sel = _max_sel,        \

    .step = _step,          \

}

​

#define STPMIC1_OUTPUT(_ranges, _nbranges) { \

    .ranges = _ranges,      \

    .nbranges = _nbranges,      \

}

​

static int stpmic1_output_find_uv(int sel,

                  const struct stpmic1_output *output)

{

    const struct stpmic1_range *range;

    int i;

​

    for (i = 0, range = output->ranges;

         i < output->nbranges; i++, range++) {

        if (sel >= range->min_sel && sel <= range->max_sel)

            return range->min_uv +

                   (sel - range->min_sel) * range->step;

    }

​

    return -EINVAL;

}

​

static int stpmic1_output_find_sel(int uv,

                   const struct stpmic1_output *output)

{

    const struct stpmic1_range *range;

    int i;

​

    for (i = 0, range = output->ranges;

         i < output->nbranges; i++, range++) {

        if (uv == range->min_uv && !range->step)

            return range->min_sel;

​

        if (uv >= range->min_uv &&

            uv <= range->min_uv +

              (range->max_sel - range->min_sel) * range->step)

            return range->min_sel +

                   (uv - range->min_uv) / range->step;

    }

​

    return -EINVAL;

}

​

/*

 * BUCK regulators

 */

​

static const struct stpmic1_range buck1_ranges[] = {

    STPMIC1_RANGE(725000, 0, 4, 0),

    STPMIC1_RANGE(725000, 5, 36, 25000),

    STPMIC1_RANGE(1500000, 37, 63, 0),

};

​

static const struct stpmic1_range buck2_ranges[] = {

    STPMIC1_RANGE(1000000, 0, 17, 0),