xref: /arm-trusted-firmware/drivers/marvell/thermal.c (revision 91f16700b400a8c0651d24a598fc48ee2997a0d7)
1*91f16700Schasinglulu /*
2*91f16700Schasinglulu  * Copyright (C) 2018 Marvell International Ltd.
3*91f16700Schasinglulu  *
4*91f16700Schasinglulu  * SPDX-License-Identifier:	BSD-3-Clause
5*91f16700Schasinglulu  * https://spdx.org/licenses
6*91f16700Schasinglulu  */
7*91f16700Schasinglulu 
8*91f16700Schasinglulu /* Driver for thermal unit located in Marvell ARMADA 8K and compatible SoCs */
9*91f16700Schasinglulu 
10*91f16700Schasinglulu #include <common/debug.h>
11*91f16700Schasinglulu #include <drivers/marvell/thermal.h>
12*91f16700Schasinglulu 
13*91f16700Schasinglulu int marvell_thermal_init(struct tsen_config *tsen_cfg)
14*91f16700Schasinglulu {
15*91f16700Schasinglulu 	if (tsen_cfg->tsen_ready == 1) {
16*91f16700Schasinglulu 		INFO("thermal sensor is already initialized\n");
17*91f16700Schasinglulu 		return 0;
18*91f16700Schasinglulu 	}
19*91f16700Schasinglulu 
20*91f16700Schasinglulu 	if (tsen_cfg->ptr_tsen_probe == NULL) {
21*91f16700Schasinglulu 		ERROR("initial thermal sensor configuration is missing\n");
22*91f16700Schasinglulu 		return -1;
23*91f16700Schasinglulu 	}
24*91f16700Schasinglulu 
25*91f16700Schasinglulu 	if (tsen_cfg->ptr_tsen_probe(tsen_cfg)) {
26*91f16700Schasinglulu 		ERROR("thermal sensor initialization failed\n");
27*91f16700Schasinglulu 		return -1;
28*91f16700Schasinglulu 	}
29*91f16700Schasinglulu 
30*91f16700Schasinglulu 	VERBOSE("thermal sensor was initialized\n");
31*91f16700Schasinglulu 
32*91f16700Schasinglulu 	return 0;
33*91f16700Schasinglulu }
34*91f16700Schasinglulu 
35*91f16700Schasinglulu int marvell_thermal_read(struct tsen_config *tsen_cfg, int *temp)
36*91f16700Schasinglulu {
37*91f16700Schasinglulu 	if (temp == NULL) {
38*91f16700Schasinglulu 		ERROR("NULL pointer for temperature read\n");
39*91f16700Schasinglulu 		return -1;
40*91f16700Schasinglulu 	}
41*91f16700Schasinglulu 
42*91f16700Schasinglulu 	if (tsen_cfg->ptr_tsen_read == NULL ||
43*91f16700Schasinglulu 	    tsen_cfg->tsen_ready == 0) {
44*91f16700Schasinglulu 		ERROR("thermal sensor was not initialized\n");
45*91f16700Schasinglulu 		return -1;
46*91f16700Schasinglulu 	}
47*91f16700Schasinglulu 
48*91f16700Schasinglulu 	if (tsen_cfg->ptr_tsen_read(tsen_cfg, temp)) {
49*91f16700Schasinglulu 		ERROR("temperature read failed\n");
50*91f16700Schasinglulu 		return -1;
51*91f16700Schasinglulu 	}
52*91f16700Schasinglulu 
53*91f16700Schasinglulu 	return 0;
54*91f16700Schasinglulu }
55