-
Notifications
You must be signed in to change notification settings - Fork 0
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
Add basic support regmap (register map access) API for 1-Wire bus Signed-off-by: Mark Brown <broonie@kernel.org>
- Loading branch information
Alex A. Mihaylov
authored and
Mark Brown
committed
Jun 6, 2017
1 parent
2ea659a
commit cc5d0db
Showing
4 changed files
with
285 additions
and
1 deletion.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,245 @@ | ||
/* | ||
* Register map access API - W1 (1-Wire) support | ||
* | ||
* Copyright (C) 2017 OAO Radioavionica | ||
* Author: Alex A. Mihaylov <minimumlaw@rambler.ru> | ||
* | ||
* 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/regmap.h> | ||
#include <linux/module.h> | ||
#include "../../w1/w1.h" | ||
|
||
#include "internal.h" | ||
|
||
#define W1_CMD_READ_DATA 0x69 | ||
#define W1_CMD_WRITE_DATA 0x6C | ||
|
||
/* | ||
* 1-Wire slaves registers with addess 8 bit and data 8 bit | ||
*/ | ||
|
||
static int w1_reg_a8_v8_read(void *context, unsigned int reg, unsigned int *val) | ||
{ | ||
struct device *dev = context; | ||
struct w1_slave *sl = container_of(dev, struct w1_slave, dev); | ||
int ret = 0; | ||
|
||
if (reg > 255) | ||
return -EINVAL; | ||
|
||
mutex_lock(&sl->master->bus_mutex); | ||
if (!w1_reset_select_slave(sl)) { | ||
w1_write_8(sl->master, W1_CMD_READ_DATA); | ||
w1_write_8(sl->master, reg); | ||
*val = w1_read_8(sl->master); | ||
} else { | ||
ret = -ENODEV; | ||
} | ||
mutex_unlock(&sl->master->bus_mutex); | ||
|
||
return ret; | ||
} | ||
|
||
static int w1_reg_a8_v8_write(void *context, unsigned int reg, unsigned int val) | ||
{ | ||
struct device *dev = context; | ||
struct w1_slave *sl = container_of(dev, struct w1_slave, dev); | ||
int ret = 0; | ||
|
||
if (reg > 255) | ||
return -EINVAL; | ||
|
||
mutex_lock(&sl->master->bus_mutex); | ||
if (!w1_reset_select_slave(sl)) { | ||
w1_write_8(sl->master, W1_CMD_WRITE_DATA); | ||
w1_write_8(sl->master, reg); | ||
w1_write_8(sl->master, val); | ||
} else { | ||
ret = -ENODEV; | ||
} | ||
mutex_unlock(&sl->master->bus_mutex); | ||
|
||
return ret; | ||
} | ||
|
||
/* | ||
* 1-Wire slaves registers with addess 8 bit and data 16 bit | ||
*/ | ||
|
||
static int w1_reg_a8_v16_read(void *context, unsigned int reg, | ||
unsigned int *val) | ||
{ | ||
struct device *dev = context; | ||
struct w1_slave *sl = container_of(dev, struct w1_slave, dev); | ||
int ret = 0; | ||
|
||
if (reg > 255) | ||
return -EINVAL; | ||
|
||
mutex_lock(&sl->master->bus_mutex); | ||
if (!w1_reset_select_slave(sl)) { | ||
w1_write_8(sl->master, W1_CMD_READ_DATA); | ||
w1_write_8(sl->master, reg); | ||
*val = w1_read_8(sl->master); | ||
*val |= w1_read_8(sl->master)<<8; | ||
} else { | ||
ret = -ENODEV; | ||
} | ||
mutex_unlock(&sl->master->bus_mutex); | ||
|
||
return ret; | ||
} | ||
|
||
static int w1_reg_a8_v16_write(void *context, unsigned int reg, | ||
unsigned int val) | ||
{ | ||
struct device *dev = context; | ||
struct w1_slave *sl = container_of(dev, struct w1_slave, dev); | ||
int ret = 0; | ||
|
||
if (reg > 255) | ||
return -EINVAL; | ||
|
||
mutex_lock(&sl->master->bus_mutex); | ||
if (!w1_reset_select_slave(sl)) { | ||
w1_write_8(sl->master, W1_CMD_WRITE_DATA); | ||
w1_write_8(sl->master, reg); | ||
w1_write_8(sl->master, val & 0x00FF); | ||
w1_write_8(sl->master, val>>8 & 0x00FF); | ||
} else { | ||
ret = -ENODEV; | ||
} | ||
mutex_unlock(&sl->master->bus_mutex); | ||
|
||
return ret; | ||
} | ||
|
||
/* | ||
* 1-Wire slaves registers with addess 16 bit and data 16 bit | ||
*/ | ||
|
||
static int w1_reg_a16_v16_read(void *context, unsigned int reg, | ||
unsigned int *val) | ||
{ | ||
struct device *dev = context; | ||
struct w1_slave *sl = container_of(dev, struct w1_slave, dev); | ||
int ret = 0; | ||
|
||
if (reg > 65535) | ||
return -EINVAL; | ||
|
||
mutex_lock(&sl->master->bus_mutex); | ||
if (!w1_reset_select_slave(sl)) { | ||
w1_write_8(sl->master, W1_CMD_READ_DATA); | ||
w1_write_8(sl->master, reg & 0x00FF); | ||
w1_write_8(sl->master, reg>>8 & 0x00FF); | ||
*val = w1_read_8(sl->master); | ||
*val |= w1_read_8(sl->master)<<8; | ||
} else { | ||
ret = -ENODEV; | ||
} | ||
mutex_unlock(&sl->master->bus_mutex); | ||
|
||
return ret; | ||
} | ||
|
||
static int w1_reg_a16_v16_write(void *context, unsigned int reg, | ||
unsigned int val) | ||
{ | ||
struct device *dev = context; | ||
struct w1_slave *sl = container_of(dev, struct w1_slave, dev); | ||
int ret = 0; | ||
|
||
if (reg > 65535) | ||
return -EINVAL; | ||
|
||
mutex_lock(&sl->master->bus_mutex); | ||
if (!w1_reset_select_slave(sl)) { | ||
w1_write_8(sl->master, W1_CMD_WRITE_DATA); | ||
w1_write_8(sl->master, reg & 0x00FF); | ||
w1_write_8(sl->master, reg>>8 & 0x00FF); | ||
w1_write_8(sl->master, val & 0x00FF); | ||
w1_write_8(sl->master, val>>8 & 0x00FF); | ||
} else { | ||
ret = -ENODEV; | ||
} | ||
mutex_unlock(&sl->master->bus_mutex); | ||
|
||
return ret; | ||
} | ||
|
||
/* | ||
* Various types of supported bus addressing | ||
*/ | ||
|
||
static struct regmap_bus regmap_w1_bus_a8_v8 = { | ||
.reg_read = w1_reg_a8_v8_read, | ||
.reg_write = w1_reg_a8_v8_write, | ||
}; | ||
|
||
static struct regmap_bus regmap_w1_bus_a8_v16 = { | ||
.reg_read = w1_reg_a8_v16_read, | ||
.reg_write = w1_reg_a8_v16_write, | ||
}; | ||
|
||
static struct regmap_bus regmap_w1_bus_a16_v16 = { | ||
.reg_read = w1_reg_a16_v16_read, | ||
.reg_write = w1_reg_a16_v16_write, | ||
}; | ||
|
||
static const struct regmap_bus *regmap_get_w1_bus(struct device *w1_dev, | ||
const struct regmap_config *config) | ||
{ | ||
if (config->reg_bits == 8 && config->val_bits == 8) | ||
return ®map_w1_bus_a8_v8; | ||
|
||
if (config->reg_bits == 8 && config->val_bits == 16) | ||
return ®map_w1_bus_a8_v16; | ||
|
||
if (config->reg_bits == 16 && config->val_bits == 16) | ||
return ®map_w1_bus_a16_v16; | ||
|
||
return ERR_PTR(-ENOTSUPP); | ||
} | ||
|
||
struct regmap *__regmap_init_w1(struct device *w1_dev, | ||
const struct regmap_config *config, | ||
struct lock_class_key *lock_key, | ||
const char *lock_name) | ||
{ | ||
|
||
const struct regmap_bus *bus = regmap_get_w1_bus(w1_dev, config); | ||
|
||
if (IS_ERR(bus)) | ||
return ERR_CAST(bus); | ||
|
||
return __regmap_init(w1_dev, bus, w1_dev, config, | ||
lock_key, lock_name); | ||
|
||
return NULL; | ||
} | ||
EXPORT_SYMBOL_GPL(__regmap_init_w1); | ||
|
||
struct regmap *__devm_regmap_init_w1(struct device *w1_dev, | ||
const struct regmap_config *config, | ||
struct lock_class_key *lock_key, | ||
const char *lock_name) | ||
{ | ||
|
||
const struct regmap_bus *bus = regmap_get_w1_bus(w1_dev, config); | ||
|
||
if (IS_ERR(bus)) | ||
return ERR_CAST(bus); | ||
|
||
return __devm_regmap_init(w1_dev, bus, w1_dev, config, | ||
lock_key, lock_name); | ||
|
||
return NULL; | ||
} | ||
EXPORT_SYMBOL_GPL(__devm_regmap_init_w1); | ||
|
||
MODULE_LICENSE("GPL"); |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters