blob: eb28ca613f72f7c8b7d2334ab99460562f4d72e0 (
plain)
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
|
/*
* This file is part of the coreboot project.
*
* Copyright 2016 Rockchip Inc.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; version 2 of the License.
*
* 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 <arch/io.h>
#include <assert.h>
#include <delay.h>
#include <soc/clock.h>
#include <soc/saradc.h>
#include <stdint.h>
#include <stdlib.h>
#include <timer.h>
struct rk3399_saradc_regs {
u32 data;
u32 stas;
u32 ctrl;
u32 dly_pu_soc;
};
check_member(rk3399_saradc_regs, dly_pu_soc, 0xc);
struct rk3399_saradc_regs *rk3399_saradc = (void *)SARADC_BASE;
/* SARADC_STAS: conversion done */
#define ADC_STOP 0
/* SARADC_CTRL */
#define INT_EN (1 << 5)
#define ADC_PWR_CTRL (1 << 3)
#define ADC_CHN_SEL_MASK 7
#define ADC_CHN_SEL_SHIFT 0
/* SARADC_DATA, 10[0:9] bits */
#define DATA_MASK 0x3FF
#define SARADC_HZ (4*MHz)
#define SARADC_MAX_CHANNEL 6
#define SARADC_DELAY_PU (1 * 1000 * 1000 * 1000 / SARADC_HZ * 4)
u32 get_saradc_value(u32 chn)
{
u32 adc_value;
struct stopwatch sw;
assert(chn < SARADC_MAX_CHANNEL);
rkclk_configure_saradc(SARADC_HZ);
/* power down adc converter */
clrbits_le32(&rk3399_saradc->ctrl, ADC_PWR_CTRL);
/* select channel */
clrsetbits_le32(&rk3399_saradc->ctrl,
ADC_CHN_SEL_MASK << ADC_CHN_SEL_SHIFT,
chn << ADC_CHN_SEL_SHIFT);
/* power up */
setbits_le32(&rk3399_saradc->ctrl, ADC_PWR_CTRL);
udelay(SARADC_DELAY_PU);
stopwatch_init_msecs_expire(&sw, 10);
do {
if (read32(&rk3399_saradc->stas) == ADC_STOP) {
adc_value = read32(&rk3399_saradc->data) & DATA_MASK;
return adc_value;
}
} while (!stopwatch_expired(&sw));
return -1;
}
|
