1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
|
/* Copyright (c) 2014, The Linux Foundation. All rights reserved.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 and
* only version 2 as published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
*/
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/of_platform.h>
#include <soc/qcom/rpm-smd.h>
#define RPM_REQUEST_TYPE_GPIO 0x6f697067 /* gpio */
#define RPM_GPIO_NUMB_KEY 0x626d756e /* numb */
#define RPM_GPIO_STAT_KEY 0x74617473 /* stat */
#define RPM_GPIO_SETT_KEY 0x74746573 /* sett */
#define RPM_GPIO_RESOURCE_ID 3
#define GPIO_ON 1
#define GPIO_OFF 0
static int msm_send_ext_buck_votes(int gpio_num, int settling_time)
{
int rc;
int gpio_status_sleep = GPIO_OFF;
int gpio_status_active = GPIO_ON;
struct msm_rpm_kvp kvp_sleep[] = {
{
.key = RPM_GPIO_STAT_KEY,
.data = (void *)&gpio_status_sleep,
.length = sizeof(gpio_status_sleep),
}
};
struct msm_rpm_kvp kvp_active[] = {
{
.key = RPM_GPIO_NUMB_KEY,
.data = (void *)&gpio_num,
.length = sizeof(gpio_num),
},
{
.key = RPM_GPIO_STAT_KEY,
.data = (void *)&gpio_status_active,
.length = sizeof(gpio_status_active),
},
{
.key = RPM_GPIO_SETT_KEY,
.data = (void *)&settling_time,
.length = sizeof(settling_time),
},
};
rc = msm_rpm_send_message(MSM_RPM_CTX_ACTIVE_SET,
RPM_REQUEST_TYPE_GPIO, RPM_GPIO_RESOURCE_ID, kvp_active,
ARRAY_SIZE(kvp_active));
WARN(rc < 0, "RPM GPIO toggling (active set) did not enable!\n");
rc = msm_rpm_send_message(MSM_RPM_CTX_SLEEP_SET,
RPM_REQUEST_TYPE_GPIO, RPM_GPIO_RESOURCE_ID, kvp_sleep,
ARRAY_SIZE(kvp_sleep));
WARN(rc < 0, "RPM GPIO toggling (sleep set) did not enable!\n");
return rc;
}
static int msm_ext_buck_probe(struct platform_device *pdev)
{
char *key = NULL;
int gpio_num;
int settling_time_us;
int ret = 0;
key = "qcom,gpio-num";
ret = of_property_read_u32(pdev->dev.of_node, key, &gpio_num);
if (ret) {
pr_err("%s: Cannot read %s from dt (ret:%d)\n",
__func__, key, ret);
return ret;
}
key = "qcom,settling-time-us";
ret = of_property_read_u32(pdev->dev.of_node, key,
&settling_time_us);
if (ret) {
pr_err("%s: Cannot read %s from dt (ret:%d)\n",
__func__, key, ret);
return ret;
}
ret = msm_send_ext_buck_votes(gpio_num, settling_time_us);
return ret;
}
static struct of_device_id msm_ext_buck_table[] = {
{.compatible = "qcom,ext-buck-control"},
{},
};
static struct platform_driver msm_ext_buck_driver = {
.probe = msm_ext_buck_probe,
.driver = {
.name = "ext-buck-control",
.owner = THIS_MODULE,
.of_match_table = msm_ext_buck_table,
},
};
static int __init msm_ext_buck_init(void)
{
return platform_driver_register(&msm_ext_buck_driver);
}
late_initcall(msm_ext_buck_init);
|
