usb: kbd: Prevent out of bound access
[platform/kernel/u-boot.git] / common / cmd_dtt.c
1 /*
2  * (C) Copyright 2001
3  * Erik Theisen, Wave 7 Optics, etheisen@mindspring.com
4  *
5  * SPDX-License-Identifier:     GPL-2.0+
6  */
7
8 #include <common.h>
9 #include <config.h>
10 #include <command.h>
11
12 #include <dtt.h>
13 #include <i2c.h>
14 #include <tmu.h>
15
16 #if defined CONFIG_DTT_SENSORS
17 static unsigned long sensor_initialized;
18
19 static void _initialize_dtt(void)
20 {
21         int i;
22         unsigned char sensors[] = CONFIG_DTT_SENSORS;
23
24         for (i = 0; i < sizeof(sensors); i++) {
25                 if ((sensor_initialized & (1 << i)) == 0) {
26                         if (dtt_init_one(sensors[i]) != 0) {
27                                 printf("DTT%d: Failed init!\n", i);
28                                 continue;
29                         }
30                         sensor_initialized |= (1 << i);
31                 }
32         }
33 }
34
35 void dtt_init(void)
36 {
37         int old_bus;
38
39         /* switch to correct I2C bus */
40         old_bus = I2C_GET_BUS();
41         I2C_SET_BUS(CONFIG_SYS_DTT_BUS_NUM);
42
43         _initialize_dtt();
44
45         /* switch back to original I2C bus */
46         I2C_SET_BUS(old_bus);
47 }
48 #endif
49
50 int dtt_i2c(void)
51 {
52 #if defined CONFIG_DTT_SENSORS
53         int i;
54         unsigned char sensors[] = CONFIG_DTT_SENSORS;
55         int old_bus;
56
57         /* Force a compilation error, if there are more then 32 sensors */
58         BUILD_BUG_ON(sizeof(sensors) > 32);
59         /* switch to correct I2C bus */
60 #ifdef CONFIG_SYS_I2C
61         old_bus = i2c_get_bus_num();
62         i2c_set_bus_num(CONFIG_SYS_DTT_BUS_NUM);
63 #else
64         old_bus = I2C_GET_BUS();
65         I2C_SET_BUS(CONFIG_SYS_DTT_BUS_NUM);
66 #endif
67
68         _initialize_dtt();
69
70         /*
71          * Loop through sensors, read
72          * temperature, and output it.
73          */
74         for (i = 0; i < sizeof(sensors); i++)
75                 printf("DTT%d: %i C\n", i + 1, dtt_get_temp(sensors[i]));
76
77         /* switch back to original I2C bus */
78 #ifdef CONFIG_SYS_I2C
79         i2c_set_bus_num(old_bus);
80 #else
81         I2C_SET_BUS(old_bus);
82 #endif
83 #endif
84
85         return 0;
86 }
87
88 int dtt_tmu(void)
89 {
90 #if defined CONFIG_TMU_CMD_DTT
91         int cur_temp;
92
93         /* Sense and return latest thermal info */
94         if (tmu_monitor(&cur_temp) == TMU_STATUS_INIT) {
95                 puts("TMU is in unknown state, temperature is invalid\n");
96                 return -1;
97         }
98         printf("Current temperature: %u degrees Celsius\n", cur_temp);
99 #endif
100         return 0;
101 }
102
103 int do_dtt(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
104 {
105         int err = 0;
106
107         err |= dtt_i2c();
108         err |= dtt_tmu();
109
110         return err;
111 }       /* do_dtt() */
112
113 /***************************************************/
114
115 U_BOOT_CMD(
116           dtt,  1,      1,      do_dtt,
117           "Read temperature from Digital Thermometer and Thermostat",
118           ""
119 );