mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-20 00:48:52 +09:00
![Rasmus Villemoes](/assets/img/avatar_default.png)
Similar to how the dm_rtc_{read,write} functions fall back to using the {read,write}8 methods, do the opposite in the rtc_{read,write}8 functions. This way, each driver only needs to provide either ->read8 or ->read to make both rtc_read8() and dm_rtc_read() work - without this, a driver that provides ->read() would most likely just duplicate the logic here for implementing a ->read8() method in term of its ->read() method. The same remarks of course apply to the write case. Reviewed-by: Simon Glass <sjg@chromium.org> Reviewed-by: Heiko Schocher <hs@denx.de> Signed-off-by: Rasmus Villemoes <rasmus.villemoes@prevas.dk>
179 lines
3.0 KiB
C
179 lines
3.0 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* (C) Copyright 2015 Google, Inc
|
|
* Written by Simon Glass <sjg@chromium.org>
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <dm.h>
|
|
#include <errno.h>
|
|
#include <log.h>
|
|
#include <rtc.h>
|
|
|
|
int dm_rtc_get(struct udevice *dev, struct rtc_time *time)
|
|
{
|
|
struct rtc_ops *ops = rtc_get_ops(dev);
|
|
|
|
assert(ops);
|
|
if (!ops->get)
|
|
return -ENOSYS;
|
|
return ops->get(dev, time);
|
|
}
|
|
|
|
int dm_rtc_set(struct udevice *dev, struct rtc_time *time)
|
|
{
|
|
struct rtc_ops *ops = rtc_get_ops(dev);
|
|
|
|
assert(ops);
|
|
if (!ops->set)
|
|
return -ENOSYS;
|
|
return ops->set(dev, time);
|
|
}
|
|
|
|
int dm_rtc_reset(struct udevice *dev)
|
|
{
|
|
struct rtc_ops *ops = rtc_get_ops(dev);
|
|
|
|
assert(ops);
|
|
if (!ops->reset)
|
|
return -ENOSYS;
|
|
return ops->reset(dev);
|
|
}
|
|
|
|
int dm_rtc_read(struct udevice *dev, unsigned int reg, u8 *buf, unsigned int len)
|
|
{
|
|
struct rtc_ops *ops = rtc_get_ops(dev);
|
|
|
|
assert(ops);
|
|
if (ops->read)
|
|
return ops->read(dev, reg, buf, len);
|
|
if (!ops->read8)
|
|
return -ENOSYS;
|
|
while (len--) {
|
|
int ret = ops->read8(dev, reg++);
|
|
|
|
if (ret < 0)
|
|
return ret;
|
|
*buf++ = ret;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int dm_rtc_write(struct udevice *dev, unsigned int reg,
|
|
const u8 *buf, unsigned int len)
|
|
{
|
|
struct rtc_ops *ops = rtc_get_ops(dev);
|
|
|
|
assert(ops);
|
|
if (ops->write)
|
|
return ops->write(dev, reg, buf, len);
|
|
if (!ops->write8)
|
|
return -ENOSYS;
|
|
while (len--) {
|
|
int ret = ops->write8(dev, reg++, *buf++);
|
|
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int rtc_read8(struct udevice *dev, unsigned int reg)
|
|
{
|
|
struct rtc_ops *ops = rtc_get_ops(dev);
|
|
|
|
assert(ops);
|
|
if (ops->read8)
|
|
return ops->read8(dev, reg);
|
|
if (ops->read) {
|
|
u8 buf[1];
|
|
int ret = ops->read(dev, reg, buf, 1);
|
|
|
|
if (ret < 0)
|
|
return ret;
|
|
return buf[0];
|
|
}
|
|
return -ENOSYS;
|
|
}
|
|
|
|
int rtc_write8(struct udevice *dev, unsigned int reg, int val)
|
|
{
|
|
struct rtc_ops *ops = rtc_get_ops(dev);
|
|
|
|
assert(ops);
|
|
if (ops->write8)
|
|
return ops->write8(dev, reg, val);
|
|
if (ops->write) {
|
|
u8 buf[1] = { val };
|
|
|
|
return ops->write(dev, reg, buf, 1);
|
|
}
|
|
return -ENOSYS;
|
|
}
|
|
|
|
int rtc_read16(struct udevice *dev, unsigned int reg, u16 *valuep)
|
|
{
|
|
u16 value = 0;
|
|
int ret;
|
|
int i;
|
|
|
|
for (i = 0; i < sizeof(value); i++) {
|
|
ret = rtc_read8(dev, reg + i);
|
|
if (ret < 0)
|
|
return ret;
|
|
value |= ret << (i << 3);
|
|
}
|
|
|
|
*valuep = value;
|
|
return 0;
|
|
}
|
|
|
|
int rtc_write16(struct udevice *dev, unsigned int reg, u16 value)
|
|
{
|
|
int i, ret;
|
|
|
|
for (i = 0; i < sizeof(value); i++) {
|
|
ret = rtc_write8(dev, reg + i, (value >> (i << 3)) & 0xff);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rtc_read32(struct udevice *dev, unsigned int reg, u32 *valuep)
|
|
{
|
|
u32 value = 0;
|
|
int ret;
|
|
int i;
|
|
|
|
for (i = 0; i < sizeof(value); i++) {
|
|
ret = rtc_read8(dev, reg + i);
|
|
if (ret < 0)
|
|
return ret;
|
|
value |= ret << (i << 3);
|
|
}
|
|
|
|
*valuep = value;
|
|
return 0;
|
|
}
|
|
|
|
int rtc_write32(struct udevice *dev, unsigned int reg, u32 value)
|
|
{
|
|
int i, ret;
|
|
|
|
for (i = 0; i < sizeof(value); i++) {
|
|
ret = rtc_write8(dev, reg + i, (value >> (i << 3)) & 0xff);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
UCLASS_DRIVER(rtc) = {
|
|
.name = "rtc",
|
|
.id = UCLASS_RTC,
|
|
.post_bind = dm_scan_fdt_dev,
|
|
};
|