git.oblomov.eu Git - linux-2.6/blob - drivers/net/sk98lin/sklm80.c

   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