Book a Demo!
CoCalc Logo Icon
StoreFeaturesDocsShareSupportNewsAboutPoliciesSign UpSign In
awilliam
GitHub Repository: awilliam/linux-vfio
 Path: blob/master/drivers/mfd/ab8500-sysctrl.c
15109 views
1
/*

2
 * Copyright (C) ST-Ericsson SA 2010

3
 * Author: Mattias Nilsson <[email protected]> for ST Ericsson.

4
 * License terms: GNU General Public License (GPL) version 2

5
 */

6


7
#include <linux/err.h>

8
#include <linux/platform_device.h>

9
#include <linux/mfd/ab8500.h>

10
#include <linux/mfd/abx500.h>

11
#include <linux/mfd/ab8500/sysctrl.h>

12


13
static struct device *sysctrl_dev;

14


15
static inline bool valid_bank(u8 bank)

16
{

17
	return ((bank == AB8500_SYS_CTRL1_BLOCK) ||

18
		(bank == AB8500_SYS_CTRL2_BLOCK));

19
}

20


21
int ab8500_sysctrl_read(u16 reg, u8 *value)

22
{

23
	u8 bank;

24


25
	if (sysctrl_dev == NULL)

26
		return -EAGAIN;

27


28
	bank = (reg >> 8);

29
	if (!valid_bank(bank))

30
		return -EINVAL;

31


32
	return abx500_get_register_interruptible(sysctrl_dev, bank,

33
		(u8)(reg & 0xFF), value);

34
}

35


36
int ab8500_sysctrl_write(u16 reg, u8 mask, u8 value)

37
{

38
	u8 bank;

39


40
	if (sysctrl_dev == NULL)

41
		return -EAGAIN;

42


43
	bank = (reg >> 8);

44
	if (!valid_bank(bank))

45
		return -EINVAL;

46


47
	return abx500_mask_and_set_register_interruptible(sysctrl_dev, bank,

48
		(u8)(reg & 0xFF), mask, value);

49
}

50


51
static int __devinit ab8500_sysctrl_probe(struct platform_device *pdev)

52
{

53
	sysctrl_dev = &pdev->dev;

54
	return 0;

55
}

56


57
static int __devexit ab8500_sysctrl_remove(struct platform_device *pdev)

58
{

59
	sysctrl_dev = NULL;

60
	return 0;

61
}

62


63
static struct platform_driver ab8500_sysctrl_driver = {

64
	.driver = {

65
		.name = "ab8500-sysctrl",

66
		.owner = THIS_MODULE,

67
	},

68
	.probe = ab8500_sysctrl_probe,

69
	.remove = __devexit_p(ab8500_sysctrl_remove),

70
};

71


72
static int __init ab8500_sysctrl_init(void)

73
{

74
	return platform_driver_register(&ab8500_sysctrl_driver);

75
}

76
subsys_initcall(ab8500_sysctrl_init);

77


78
MODULE_AUTHOR("Mattias Nilsson <[email protected]");

79
MODULE_DESCRIPTION("AB8500 system control driver");

80
MODULE_LICENSE("GPL v2");

81


82