181 lines
3.1 KiB
C
181 lines
3.1 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,
|
|
#if !CONFIG_IS_ENABLED(OF_PLATDATA)
|
|
.post_bind = dm_scan_fdt_dev,
|
|
#endif
|
|
};
|