315 строки
9.6 KiB
C
315 строки
9.6 KiB
C
/*
|
|
* Atmel SMC (Static Memory Controller) helper functions.
|
|
*
|
|
* Copyright (C) 2017 Atmel
|
|
* Copyright (C) 2017 Free Electrons
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
#include <linux/mfd/syscon/atmel-smc.h>
|
|
|
|
/**
|
|
* atmel_smc_cs_conf_init - initialize a SMC CS conf
|
|
* @conf: the SMC CS conf to initialize
|
|
*
|
|
* Set all fields to 0 so that one can start defining a new config.
|
|
*/
|
|
void atmel_smc_cs_conf_init(struct atmel_smc_cs_conf *conf)
|
|
{
|
|
memset(conf, 0, sizeof(*conf));
|
|
}
|
|
EXPORT_SYMBOL_GPL(atmel_smc_cs_conf_init);
|
|
|
|
/**
|
|
* atmel_smc_cs_encode_ncycles - encode a number of MCK clk cycles in the
|
|
* format expected by the SMC engine
|
|
* @ncycles: number of MCK clk cycles
|
|
* @msbpos: position of the MSB part of the timing field
|
|
* @msbwidth: width of the MSB part of the timing field
|
|
* @msbfactor: factor applied to the MSB
|
|
* @encodedval: param used to store the encoding result
|
|
*
|
|
* This function encodes the @ncycles value as described in the datasheet
|
|
* (section "SMC Setup/Pulse/Cycle/Timings Register"). This is a generic
|
|
* helper which called with different parameter depending on the encoding
|
|
* scheme.
|
|
*
|
|
* If the @ncycles value is too big to be encoded, -ERANGE is returned and
|
|
* the encodedval is contains the maximum val. Otherwise, 0 is returned.
|
|
*/
|
|
static int atmel_smc_cs_encode_ncycles(unsigned int ncycles,
|
|
unsigned int msbpos,
|
|
unsigned int msbwidth,
|
|
unsigned int msbfactor,
|
|
unsigned int *encodedval)
|
|
{
|
|
unsigned int lsbmask = GENMASK(msbpos - 1, 0);
|
|
unsigned int msbmask = GENMASK(msbwidth - 1, 0);
|
|
unsigned int msb, lsb;
|
|
int ret = 0;
|
|
|
|
msb = ncycles / msbfactor;
|
|
lsb = ncycles % msbfactor;
|
|
|
|
if (lsb > lsbmask) {
|
|
lsb = 0;
|
|
msb++;
|
|
}
|
|
|
|
/*
|
|
* Let's just put the maximum we can if the requested setting does
|
|
* not fit in the register field.
|
|
* We still return -ERANGE in case the caller cares.
|
|
*/
|
|
if (msb > msbmask) {
|
|
msb = msbmask;
|
|
lsb = lsbmask;
|
|
ret = -ERANGE;
|
|
}
|
|
|
|
*encodedval = (msb << msbpos) | lsb;
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* atmel_smc_cs_conf_set_timing - set the SMC CS conf Txx parameter to a
|
|
* specific value
|
|
* @conf: SMC CS conf descriptor
|
|
* @shift: the position of the Txx field in the TIMINGS register
|
|
* @ncycles: value (expressed in MCK clk cycles) to assign to this Txx
|
|
* parameter
|
|
*
|
|
* This function encodes the @ncycles value as described in the datasheet
|
|
* (section "SMC Timings Register"), and then stores the result in the
|
|
* @conf->timings field at @shift position.
|
|
*
|
|
* Returns -EINVAL if shift is invalid, -ERANGE if ncycles does not fit in
|
|
* the field, and 0 otherwise.
|
|
*/
|
|
int atmel_smc_cs_conf_set_timing(struct atmel_smc_cs_conf *conf,
|
|
unsigned int shift, unsigned int ncycles)
|
|
{
|
|
unsigned int val;
|
|
int ret;
|
|
|
|
if (shift != ATMEL_HSMC_TIMINGS_TCLR_SHIFT &&
|
|
shift != ATMEL_HSMC_TIMINGS_TADL_SHIFT &&
|
|
shift != ATMEL_HSMC_TIMINGS_TAR_SHIFT &&
|
|
shift != ATMEL_HSMC_TIMINGS_TRR_SHIFT &&
|
|
shift != ATMEL_HSMC_TIMINGS_TWB_SHIFT)
|
|
return -EINVAL;
|
|
|
|
/*
|
|
* The formula described in atmel datasheets (section "HSMC Timings
|
|
* Register"):
|
|
*
|
|
* ncycles = (Txx[3] * 64) + Txx[2:0]
|
|
*/
|
|
ret = atmel_smc_cs_encode_ncycles(ncycles, 3, 1, 64, &val);
|
|
conf->timings &= ~GENMASK(shift + 3, shift);
|
|
conf->timings |= val << shift;
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(atmel_smc_cs_conf_set_timing);
|
|
|
|
/**
|
|
* atmel_smc_cs_conf_set_setup - set the SMC CS conf xx_SETUP parameter to a
|
|
* specific value
|
|
* @conf: SMC CS conf descriptor
|
|
* @shift: the position of the xx_SETUP field in the SETUP register
|
|
* @ncycles: value (expressed in MCK clk cycles) to assign to this xx_SETUP
|
|
* parameter
|
|
*
|
|
* This function encodes the @ncycles value as described in the datasheet
|
|
* (section "SMC Setup Register"), and then stores the result in the
|
|
* @conf->setup field at @shift position.
|
|
*
|
|
* Returns -EINVAL if @shift is invalid, -ERANGE if @ncycles does not fit in
|
|
* the field, and 0 otherwise.
|
|
*/
|
|
int atmel_smc_cs_conf_set_setup(struct atmel_smc_cs_conf *conf,
|
|
unsigned int shift, unsigned int ncycles)
|
|
{
|
|
unsigned int val;
|
|
int ret;
|
|
|
|
if (shift != ATMEL_SMC_NWE_SHIFT && shift != ATMEL_SMC_NCS_WR_SHIFT &&
|
|
shift != ATMEL_SMC_NRD_SHIFT && shift != ATMEL_SMC_NCS_RD_SHIFT)
|
|
return -EINVAL;
|
|
|
|
/*
|
|
* The formula described in atmel datasheets (section "SMC Setup
|
|
* Register"):
|
|
*
|
|
* ncycles = (128 * xx_SETUP[5]) + xx_SETUP[4:0]
|
|
*/
|
|
ret = atmel_smc_cs_encode_ncycles(ncycles, 5, 1, 128, &val);
|
|
conf->setup &= ~GENMASK(shift + 7, shift);
|
|
conf->setup |= val << shift;
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(atmel_smc_cs_conf_set_setup);
|
|
|
|
/**
|
|
* atmel_smc_cs_conf_set_pulse - set the SMC CS conf xx_PULSE parameter to a
|
|
* specific value
|
|
* @conf: SMC CS conf descriptor
|
|
* @shift: the position of the xx_PULSE field in the PULSE register
|
|
* @ncycles: value (expressed in MCK clk cycles) to assign to this xx_PULSE
|
|
* parameter
|
|
*
|
|
* This function encodes the @ncycles value as described in the datasheet
|
|
* (section "SMC Pulse Register"), and then stores the result in the
|
|
* @conf->setup field at @shift position.
|
|
*
|
|
* Returns -EINVAL if @shift is invalid, -ERANGE if @ncycles does not fit in
|
|
* the field, and 0 otherwise.
|
|
*/
|
|
int atmel_smc_cs_conf_set_pulse(struct atmel_smc_cs_conf *conf,
|
|
unsigned int shift, unsigned int ncycles)
|
|
{
|
|
unsigned int val;
|
|
int ret;
|
|
|
|
if (shift != ATMEL_SMC_NWE_SHIFT && shift != ATMEL_SMC_NCS_WR_SHIFT &&
|
|
shift != ATMEL_SMC_NRD_SHIFT && shift != ATMEL_SMC_NCS_RD_SHIFT)
|
|
return -EINVAL;
|
|
|
|
/*
|
|
* The formula described in atmel datasheets (section "SMC Pulse
|
|
* Register"):
|
|
*
|
|
* ncycles = (256 * xx_PULSE[6]) + xx_PULSE[5:0]
|
|
*/
|
|
ret = atmel_smc_cs_encode_ncycles(ncycles, 6, 1, 256, &val);
|
|
conf->pulse &= ~GENMASK(shift + 7, shift);
|
|
conf->pulse |= val << shift;
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(atmel_smc_cs_conf_set_pulse);
|
|
|
|
/**
|
|
* atmel_smc_cs_conf_set_cycle - set the SMC CS conf xx_CYCLE parameter to a
|
|
* specific value
|
|
* @conf: SMC CS conf descriptor
|
|
* @shift: the position of the xx_CYCLE field in the CYCLE register
|
|
* @ncycles: value (expressed in MCK clk cycles) to assign to this xx_CYCLE
|
|
* parameter
|
|
*
|
|
* This function encodes the @ncycles value as described in the datasheet
|
|
* (section "SMC Pulse Register"), and then stores the result in the
|
|
* @conf->setup field at @shift position.
|
|
*
|
|
* Returns -EINVAL if @shift is invalid, -ERANGE if @ncycles does not fit in
|
|
* the field, and 0 otherwise.
|
|
*/
|
|
int atmel_smc_cs_conf_set_cycle(struct atmel_smc_cs_conf *conf,
|
|
unsigned int shift, unsigned int ncycles)
|
|
{
|
|
unsigned int val;
|
|
int ret;
|
|
|
|
if (shift != ATMEL_SMC_NWE_SHIFT && shift != ATMEL_SMC_NRD_SHIFT)
|
|
return -EINVAL;
|
|
|
|
/*
|
|
* The formula described in atmel datasheets (section "SMC Cycle
|
|
* Register"):
|
|
*
|
|
* ncycles = (xx_CYCLE[8:7] * 256) + xx_CYCLE[6:0]
|
|
*/
|
|
ret = atmel_smc_cs_encode_ncycles(ncycles, 7, 2, 256, &val);
|
|
conf->cycle &= ~GENMASK(shift + 15, shift);
|
|
conf->cycle |= val << shift;
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(atmel_smc_cs_conf_set_cycle);
|
|
|
|
/**
|
|
* atmel_smc_cs_conf_apply - apply an SMC CS conf
|
|
* @regmap: the SMC regmap
|
|
* @cs: the CS id
|
|
* @conf the SMC CS conf to apply
|
|
*
|
|
* Applies an SMC CS configuration.
|
|
* Only valid on at91sam9/avr32 SoCs.
|
|
*/
|
|
void atmel_smc_cs_conf_apply(struct regmap *regmap, int cs,
|
|
const struct atmel_smc_cs_conf *conf)
|
|
{
|
|
regmap_write(regmap, ATMEL_SMC_SETUP(cs), conf->setup);
|
|
regmap_write(regmap, ATMEL_SMC_PULSE(cs), conf->pulse);
|
|
regmap_write(regmap, ATMEL_SMC_CYCLE(cs), conf->cycle);
|
|
regmap_write(regmap, ATMEL_SMC_MODE(cs), conf->mode);
|
|
}
|
|
EXPORT_SYMBOL_GPL(atmel_smc_cs_conf_apply);
|
|
|
|
/**
|
|
* atmel_hsmc_cs_conf_apply - apply an SMC CS conf
|
|
* @regmap: the HSMC regmap
|
|
* @cs: the CS id
|
|
* @conf the SMC CS conf to apply
|
|
*
|
|
* Applies an SMC CS configuration.
|
|
* Only valid on post-sama5 SoCs.
|
|
*/
|
|
void atmel_hsmc_cs_conf_apply(struct regmap *regmap, int cs,
|
|
const struct atmel_smc_cs_conf *conf)
|
|
{
|
|
regmap_write(regmap, ATMEL_HSMC_SETUP(cs), conf->setup);
|
|
regmap_write(regmap, ATMEL_HSMC_PULSE(cs), conf->pulse);
|
|
regmap_write(regmap, ATMEL_HSMC_CYCLE(cs), conf->cycle);
|
|
regmap_write(regmap, ATMEL_HSMC_TIMINGS(cs), conf->timings);
|
|
regmap_write(regmap, ATMEL_HSMC_MODE(cs), conf->mode);
|
|
}
|
|
EXPORT_SYMBOL_GPL(atmel_hsmc_cs_conf_apply);
|
|
|
|
/**
|
|
* atmel_smc_cs_conf_get - retrieve the current SMC CS conf
|
|
* @regmap: the SMC regmap
|
|
* @cs: the CS id
|
|
* @conf: the SMC CS conf object to store the current conf
|
|
*
|
|
* Retrieve the SMC CS configuration.
|
|
* Only valid on at91sam9/avr32 SoCs.
|
|
*/
|
|
void atmel_smc_cs_conf_get(struct regmap *regmap, int cs,
|
|
struct atmel_smc_cs_conf *conf)
|
|
{
|
|
regmap_read(regmap, ATMEL_SMC_SETUP(cs), &conf->setup);
|
|
regmap_read(regmap, ATMEL_SMC_PULSE(cs), &conf->pulse);
|
|
regmap_read(regmap, ATMEL_SMC_CYCLE(cs), &conf->cycle);
|
|
regmap_read(regmap, ATMEL_SMC_MODE(cs), &conf->mode);
|
|
}
|
|
EXPORT_SYMBOL_GPL(atmel_smc_cs_conf_get);
|
|
|
|
/**
|
|
* atmel_hsmc_cs_conf_get - retrieve the current SMC CS conf
|
|
* @regmap: the HSMC regmap
|
|
* @cs: the CS id
|
|
* @conf: the SMC CS conf object to store the current conf
|
|
*
|
|
* Retrieve the SMC CS configuration.
|
|
* Only valid on post-sama5 SoCs.
|
|
*/
|
|
void atmel_hsmc_cs_conf_get(struct regmap *regmap, int cs,
|
|
struct atmel_smc_cs_conf *conf)
|
|
{
|
|
regmap_read(regmap, ATMEL_HSMC_SETUP(cs), &conf->setup);
|
|
regmap_read(regmap, ATMEL_HSMC_PULSE(cs), &conf->pulse);
|
|
regmap_read(regmap, ATMEL_HSMC_CYCLE(cs), &conf->cycle);
|
|
regmap_read(regmap, ATMEL_HSMC_TIMINGS(cs), &conf->timings);
|
|
regmap_read(regmap, ATMEL_HSMC_MODE(cs), &conf->mode);
|
|
}
|
|
EXPORT_SYMBOL_GPL(atmel_hsmc_cs_conf_get);
|