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
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
|
#include <linux/init.h>
#include <linux/suspend.h>
#include <linux/kobject.h>
#include <linux/fs.h>
#include <linux/io.h>
#include <linux/errno.h>
#include <linux/mm.h>
#include <linux/io.h>
#include <linux/debugfs.h>
#include <linux/delay.h>
#include <linux/wakelock.h>
#include <linux/module.h>
#include <linux/kthread.h>
#include <mach/common.h>
#include <mach/hardware.h>
#include <mach/sci.h>
#include <linux/earlysuspend.h>
#include <mach/sci_glb_regs.h>
#include <mach/adi.h>
#include <linux/random.h>
#include <asm/hardware/cache-l2x0.h>
#include <asm/cacheflush.h>
#include <asm/suspend.h>
#include <linux/vmalloc.h>
#include <linux/printk.h>
#include <linux/timer.h>
#include <linux/jiffies.h>
struct avs_hw_ctrl
{
volatile u32 avs_tune_lmt_cfg;
volatile u32 avs_tune_status;
volatile u32 avs_cfg;
volatile u32 avs_tune_step_cfg;
volatile u32 avs_wait_cfg;
volatile u32 avs_int_cfg;
volatile u32 avs_start_single_act;
volatile u32 avs_start_repeat_act;
volatile u32 avs_hpm_en;
volatile u32 avs_hpm_rpt_anls;
volatile u32 avs_hpm_rpt_vld_status[4];
volatile u32 avs_hpm_dly_wind_sel;
volatile u32 avs_fsm_sts;
};
struct sprd_avs_info
{
struct avs_hw_ctrl *chip;
struct timer_list avs_timer;
struct dentry *debug_avs_dir;
volatile u32 printfreq;
u32 window;
};
static struct sprd_avs_info sai;
static void avs_init(void)
{
/* avs enable */
sci_glb_set(REG_AON_APB_APB_EB1,1 << 6);
}
static void avs_trigger(void)
{
/* avs hpm enable */
sai.chip->avs_hpm_en |= (1 << 1);
/* avs tune limit cfg */
sai.chip->avs_tune_lmt_cfg = 0xff80;
/* avs hpm rpt anls */
sai.chip->avs_hpm_rpt_anls = 0x3FF94;
/* start avs */
sai.chip->avs_start_repeat_act = 0x1;
/* delay for something */
udelay(5);
}
static void avs_timer_func(unsigned long data)
{
static u32 arm_voltage_int[]={1100,700,800,900,1000,650,1200,1300};
u32 reg_val = sci_adi_read(ANA_REG_GLB_DCDC_ARM_ADI);
u32 int_part,frc_part;
int_part = arm_voltage_int[(reg_val & 0x7) >> 5];
frc_part = (reg_val & 0x1F)*3;
avs_trigger();
printk("****************************avs debug**********************************\r\n");
sai.window = sai.chip->avs_hpm_rpt_vld_status[0];
printk("avs window 0x%x arm voltage is %d mv\r\n",sai.window,(int_part + frc_part));
printk("****************************avs debug**********************************\r\n");
mod_timer(&sai.avs_timer,jiffies + msecs_to_jiffies(sai.printfreq + 10000));
}
static int debugfs_avs_printfreq_get(void *data, u64 * val)
{
*(u32 *) data = *val = sai.printfreq;
return 0;
}
static int debugfs_avs_printfreq__set(void *data, u64 val)
{
sai.printfreq = *(u32 *) data = val;
return 0;
}
DEFINE_SIMPLE_ATTRIBUTE(fops_avs_printfreq,
debugfs_avs_printfreq_get, debugfs_avs_printfreq__set, "%llu\n");
static void avs_debugfs_create(void)
{
sai.debug_avs_dir = debugfs_create_dir("avs_dir", NULL);
if (IS_ERR_OR_NULL(sai.debug_avs_dir)) {
pr_err("%s return %p\n", __FUNCTION__, sai.debug_avs_dir);
}
debugfs_create_file("avs", S_IRUGO | S_IWUGO,
sai.debug_avs_dir, &sai.printfreq, &fops_avs_printfreq);
}
static int __init avs_debug_init(void)
{
sai.chip = (struct avs_hw_ctrl*)SPRD_AVSCA7_BASE;
init_timer(&sai.avs_timer);
sai.avs_timer.function = avs_timer_func;
sai.avs_timer.expires = jiffies + msecs_to_jiffies(2000);
sai.avs_timer.data = (u32)&sai;
avs_init();
avs_debugfs_create();
add_timer(&sai.avs_timer);
return 0;
}
static void __exit avs_debug_exit(void)
{
del_timer_sync(&sai.avs_timer);
}
module_init(avs_debug_init);
module_exit(avs_debug_exit);
|
