diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /drivers/net/sk98lin/sklm80.c |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'drivers/net/sk98lin/sklm80.c')
-rw-r--r-- | drivers/net/sk98lin/sklm80.c | 213 |
1 files changed, 213 insertions, 0 deletions
diff --git a/drivers/net/sk98lin/sklm80.c b/drivers/net/sk98lin/sklm80.c new file mode 100644 index 000000000000..68292d18175b --- /dev/null +++ b/drivers/net/sk98lin/sklm80.c | |||
@@ -0,0 +1,213 @@ | |||
1 | /****************************************************************************** | ||
2 | * | ||
3 | * Name: sklm80.c | ||
4 | * Project: Gigabit Ethernet Adapters, TWSI-Module | ||
5 | * Version: $Revision: 1.22 $ | ||
6 | * Date: $Date: 2003/10/20 09:08:21 $ | ||
7 | * Purpose: Functions to access Voltage and Temperature Sensor (LM80) | ||
8 | * | ||
9 | ******************************************************************************/ | ||
10 | |||
11 | /****************************************************************************** | ||
12 | * | ||
13 | * (C)Copyright 1998-2002 SysKonnect. | ||
14 | * (C)Copyright 2002-2003 Marvell. | ||
15 | * | ||
16 | * This program is free software; you can redistribute it and/or modify | ||
17 | * it under the terms of the GNU General Public License as published by | ||
18 | * the Free Software Foundation; either version 2 of the License, or | ||
19 | * (at your option) any later version. | ||
20 | * | ||
21 | * The information in this file is provided "AS IS" without warranty. | ||
22 | * | ||
23 | ******************************************************************************/ | ||
24 | |||
25 | /* | ||
26 | LM80 functions | ||
27 | */ | ||
28 | #if (defined(DEBUG) || ((!defined(LINT)) && (!defined(SK_SLIM)))) | ||
29 | static const char SysKonnectFileId[] = | ||
30 | "@(#) $Id: sklm80.c,v 1.22 2003/10/20 09:08:21 rschmidt Exp $ (C) Marvell. "; | ||
31 | #endif | ||
32 | |||
33 | #include "h/skdrv1st.h" /* Driver Specific Definitions */ | ||
34 | #include "h/lm80.h" | ||
35 | #include "h/skdrv2nd.h" /* Adapter Control- and Driver specific Def. */ | ||
36 | |||
37 | #ifdef SK_DIAG | ||
38 | #define BREAK_OR_WAIT(pAC,IoC,Event) SkI2cWait(pAC,IoC,Event) | ||
39 | #else /* nSK_DIAG */ | ||
40 | #define BREAK_OR_WAIT(pAC,IoC,Event) break | ||
41 | #endif /* nSK_DIAG */ | ||
42 | |||
43 | #ifdef SK_DIAG | ||
44 | /* | ||
45 | * read the register 'Reg' from the device 'Dev' | ||
46 | * | ||
47 | * return read error -1 | ||
48 | * success the read value | ||
49 | */ | ||
50 | int SkLm80RcvReg( | ||
51 | SK_IOC IoC, /* Adapter Context */ | ||
52 | int Dev, /* I2C device address */ | ||
53 | int Reg) /* register to read */ | ||
54 | { | ||
55 | int Val = 0; | ||
56 | int TempExt; | ||
57 | |||
58 | /* Signal device number */ | ||
59 | if (SkI2cSndDev(IoC, Dev, I2C_WRITE)) { | ||
60 | return(-1); | ||
61 | } | ||
62 | |||
63 | if (SkI2cSndByte(IoC, Reg)) { | ||
64 | return(-1); | ||
65 | } | ||
66 | |||
67 | /* repeat start */ | ||
68 | if (SkI2cSndDev(IoC, Dev, I2C_READ)) { | ||
69 | return(-1); | ||
70 | } | ||
71 | |||
72 | switch (Reg) { | ||
73 | case LM80_TEMP_IN: | ||
74 | Val = (int)SkI2cRcvByte(IoC, 1); | ||
75 | |||
76 | /* First: correct the value: it might be negative */ | ||
77 | if ((Val & 0x80) != 0) { | ||
78 | /* Value is negative */ | ||
79 | Val = Val - 256; | ||
80 | } | ||
81 | Val = Val * SK_LM80_TEMP_LSB; | ||
82 | SkI2cStop(IoC); | ||
83 | |||
84 | TempExt = (int)SkLm80RcvReg(IoC, LM80_ADDR, LM80_TEMP_CTRL); | ||
85 | |||
86 | if (Val > 0) { | ||
87 | Val += ((TempExt >> 7) * SK_LM80_TEMPEXT_LSB); | ||
88 | } | ||
89 | else { | ||
90 | Val -= ((TempExt >> 7) * SK_LM80_TEMPEXT_LSB); | ||
91 | } | ||
92 | return(Val); | ||
93 | break; | ||
94 | case LM80_VT0_IN: | ||
95 | case LM80_VT1_IN: | ||
96 | case LM80_VT2_IN: | ||
97 | case LM80_VT3_IN: | ||
98 | Val = (int)SkI2cRcvByte(IoC, 1) * SK_LM80_VT_LSB; | ||
99 | break; | ||
100 | |||
101 | default: | ||
102 | Val = (int)SkI2cRcvByte(IoC, 1); | ||
103 | break; | ||
104 | } | ||
105 | |||
106 | SkI2cStop(IoC); | ||
107 | return(Val); | ||
108 | } | ||
109 | #endif /* SK_DIAG */ | ||
110 | |||
111 | /* | ||
112 | * read a sensors value (LM80 specific) | ||
113 | * | ||
114 | * This function reads a sensors value from the I2C sensor chip LM80. | ||
115 | * The sensor is defined by its index into the sensors database in the struct | ||
116 | * pAC points to. | ||
117 | * | ||
118 | * Returns 1 if the read is completed | ||
119 | * 0 if the read must be continued (I2C Bus still allocated) | ||
120 | */ | ||
121 | int SkLm80ReadSensor( | ||
122 | SK_AC *pAC, /* Adapter Context */ | ||
123 | SK_IOC IoC, /* I/O Context needed in level 1 and 2 */ | ||
124 | SK_SENSOR *pSen) /* Sensor to be read */ | ||
125 | { | ||
126 | SK_I32 Value; | ||
127 | |||
128 | switch (pSen->SenState) { | ||
129 | case SK_SEN_IDLE: | ||
130 | /* Send address to ADDR register */ | ||
131 | SK_I2C_CTL(IoC, I2C_READ, pSen->SenDev, I2C_025K_DEV, pSen->SenReg, 0); | ||
132 | |||
133 | pSen->SenState = SK_SEN_VALUE ; | ||
134 | BREAK_OR_WAIT(pAC, IoC, I2C_READ); | ||
135 | |||
136 | case SK_SEN_VALUE: | ||
137 | /* Read value from data register */ | ||
138 | SK_IN32(IoC, B2_I2C_DATA, ((SK_U32 *)&Value)); | ||
139 | |||
140 | Value &= 0xff; /* only least significant byte is valid */ | ||
141 | |||
142 | /* Do NOT check the Value against the thresholds */ | ||
143 | /* Checking is done in the calling instance */ | ||
144 | |||
145 | if (pSen->SenType == SK_SEN_VOLT) { | ||
146 | /* Voltage sensor */ | ||
147 | pSen->SenValue = Value * SK_LM80_VT_LSB; | ||
148 | pSen->SenState = SK_SEN_IDLE ; | ||
149 | return(1); | ||
150 | } | ||
151 | |||
152 | if (pSen->SenType == SK_SEN_FAN) { | ||
153 | if (Value != 0 && Value != 0xff) { | ||
154 | /* Fan speed counter */ | ||
155 | pSen->SenValue = SK_LM80_FAN_FAKTOR/Value; | ||
156 | } | ||
157 | else { | ||
158 | /* Indicate Fan error */ | ||
159 | pSen->SenValue = 0; | ||
160 | } | ||
161 | pSen->SenState = SK_SEN_IDLE ; | ||
162 | return(1); | ||
163 | } | ||
164 | |||
165 | /* First: correct the value: it might be negative */ | ||
166 | if ((Value & 0x80) != 0) { | ||
167 | /* Value is negative */ | ||
168 | Value = Value - 256; | ||
169 | } | ||
170 | |||
171 | /* We have a temperature sensor and need to get the signed extension. | ||
172 | * For now we get the extension from the last reading, so in the normal | ||
173 | * case we won't see flickering temperatures. | ||
174 | */ | ||
175 | pSen->SenValue = (Value * SK_LM80_TEMP_LSB) + | ||
176 | (pSen->SenValue % SK_LM80_TEMP_LSB); | ||
177 | |||
178 | /* Send address to ADDR register */ | ||
179 | SK_I2C_CTL(IoC, I2C_READ, pSen->SenDev, I2C_025K_DEV, LM80_TEMP_CTRL, 0); | ||
180 | |||
181 | pSen->SenState = SK_SEN_VALEXT ; | ||
182 | BREAK_OR_WAIT(pAC, IoC, I2C_READ); | ||
183 | |||
184 | case SK_SEN_VALEXT: | ||
185 | /* Read value from data register */ | ||
186 | SK_IN32(IoC, B2_I2C_DATA, ((SK_U32 *)&Value)); | ||
187 | Value &= LM80_TEMP_LSB_9; /* only bit 7 is valid */ | ||
188 | |||
189 | /* cut the LSB bit */ | ||
190 | pSen->SenValue = ((pSen->SenValue / SK_LM80_TEMP_LSB) * | ||
191 | SK_LM80_TEMP_LSB); | ||
192 | |||
193 | if (pSen->SenValue < 0) { | ||
194 | /* Value negative: The bit value must be subtracted */ | ||
195 | pSen->SenValue -= ((Value >> 7) * SK_LM80_TEMPEXT_LSB); | ||
196 | } | ||
197 | else { | ||
198 | /* Value positive: The bit value must be added */ | ||
199 | pSen->SenValue += ((Value >> 7) * SK_LM80_TEMPEXT_LSB); | ||
200 | } | ||
201 | |||
202 | pSen->SenState = SK_SEN_IDLE ; | ||
203 | return(1); | ||
204 | |||
205 | default: | ||
206 | SK_ERR_LOG(pAC, SK_ERRCL_SW, SKERR_I2C_E007, SKERR_I2C_E007MSG); | ||
207 | return(1); | ||
208 | } | ||
209 | |||
210 | /* Not completed */ | ||
211 | return(0); | ||
212 | } | ||
213 | |||