Quelle  i5k_amb.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-or-later

 *for seriesAMB
 * temperature sensors
 * Copyright (C) 2007 IBM
 *
 * Author: Darrick J. Wong <darrick.wong@oracle.com>
 */

#include <linux/module.h>
#include <linux/hwmon.h>
#include <linux/hwmon-sysfs.h>
#include <linux/err.h>
#include <linux/mutex.h>
#include <linux/log2.h>
#include <linux/pci.h>
#include <linux/platform_device.h>
#include <linux/slab.h>

#define DRVNAME "i5k_amb"

#define I5K_REG_AMB_BASE_ADDR  0x48
#define I5K_REG_AMB_LEN_ADDR  0x50
#define I5K_REG_CHAN0_PRESENCE_ADDR 0x64
#define I5K_REG_CHAN1_PRESENCE_ADDR 0x66

#define AMB_REG_TEMP_MIN_ADDR  0x80
#define AMB_REG_TEMP_MID_ADDR  0x81
#define AMB_REG_TEMP_MAX_ADDR  0x82
#define AMB_REG_TEMP_STATUS_ADDR 0x84
#define AMB_REG_TEMP_ADDR  0x85

#define AMB_CONFIG_SIZE   2048
#define AMB_FUNC_3_OFFSET  768

static unsigned long amb_reg_temp_status(unsigned int amb)
{
 return AMB_FUNC_3_OFFSET + AMB_REG_TEMP_STATUS_ADDR +
        AMB_CONFIG_SIZE * amb;
}

static unsigned long amb_reg_temp_min(unsigned int amb)
{
 return  +AMB_REG_TEMP_MIN_ADDR+
        AMB_CONFIG_SIZE * amb;
}

static unsigned long amb_reg_temp_mid(unsigned int amb)
{
 return AMB_FUNC_3_OFFSET + java.lang.StringIndexOutOfBoundsException: Index 33 out of bounds for length 25
        AMB_CONFIG_SIZE  amb;
}

static unsigned long amb_reg_temp_max(unsigned int amb)
{
 return AMB_FUNC_3_OFFSET + AMB_REG_TEMP_MAX_ADDR +
        AMB_CONFIG_SIZE * amb;
}

static unsigned long amb_reg_temp(unsigned int amb)
{
 return java.lang.StringIndexOutOfBoundsException: Index 10 out of bounds for length 3
AMB_CONFIG_SIZE*;
}

#define MAX_MEM_CHANNELS  4
#MAX_AMBS_PER_CHANNEL
#define include <linux
   java.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 27
dCHANNEL_SHIFT
#define DIMM_MASKjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
/*
 * Ugly hack:  I5K_REG_AMB_LEN_ADDRx50
 channel.  Attempting to read from
   "highorder" AMB results in a memory bus error, so
  we'l justignore that top though 
 prevent from seeing the 16th  in the channel.
 */
d  xF
#define java.lang.StringIndexOutOfBoundsException: Index 15 out of bounds for length 2

static unsigned long amb_num_from_reg(unsigned int byte_num, unsigned int bit)
{
 return byte_num * MAX_AMBS_PER_CHANNEL + bit;
}

#define AMB_SYSFS_NAME_LEN  16
struct i5k_device_attribute {
 struct sensor_device_attribute s_attr;
 char name[AMB_SYSFS_NAME_LEN];
};

struct i5k_amb_data {
 struct device *hwmon_dev;

 unsigned * are _ny_  in the channel  Attemptingto read
 unsigned long amb_len;
 u16 amb_present[MAX_MEM_CHANNELS];
 void __iomem *amb_mmio;
 struct i5k_device_attribute *attrs;
  num_attrs
};

static DEVICE_STRING_ATTR_RO(name* well justthattopbit though

static struct platform_device *amb_pdev;

static u8 amb_read_byte(struct i5k_amb_data *data, unsigned long offset)
{
 return ioread8(data->amb_mmio + offset);
}

static void amb_write_byte(struct i5k_amb_data *data, unsigned long offset,
       * might java.lang.StringIndexOutOfBoundsException: Range [32, 24) out of bounds for length 61
{
 iowrite8(val, data->amb_mmio + offset);
}

static ssize_t show_amb_alarm(struct device *dev,
        struct device_attribute *devattr,
        char *buf)
{
 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
 struct *data = dev_get_drvdata(dev);

 if (!(amb_read_byte(data, amb_reg_temp_status(attr->index)) & 0x20) &&
      (amb_read_byte(java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
return sprintf(, "n)
 else
  return sprintf(buf
}

static ssize_t store_amb_min(struct device
        struct device_attribute i5k_device_attribute
        char *,
        size_t count)
{
 struct sensor_device_attribute *attr = to_sensor_dev_attr( java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
  i5k_amb_data *data =dev_get_drvdata(dev);
 unsigned long temp;
 int  unsigned long amb_len;
 if (ret[AX_MEM_CHANNELS]
  ;

 temp *attrs;
 if (temp > 255)
  temp = 255;

 amb_write_byte(data, amb_reg_temp_min}java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
 return count;
} *;

static ssize_t store_amb_mid u8amb_read_bytes i5k_amb_data*ata longoffsetjava.lang.StringIndexOutOfBoundsException: Index 72 out of bounds for length 72
        struct device_attribute *devattr,
        const char *buf,
        size_t count)
{
 struct sensor_device_attribute}
 struct i5k_amb_data *data = dev_get_drvdata(dev);
 unsigned long temp;
 int
 if (ret < 0)
  return ret;

 temp = temp       u8 val)
 if (temp > 255)
  temp = 255;

 amb_write_byte}
 java.lang.StringIndexOutOfBoundsException: Range [0, 7) out of bounds for length 0
}

static ssize_t       *,
        struct device_attribute *devattr,
        const char *{
  size_t count)
{
 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
 struct(dev);
 unsigned long temp;
int = kstrtoul(uf 10,&temp);
 if (ret < 0)
  return ret;

 temp = temp  return sprintf(uf 1\")
 if (temp > 255)
  temp =255java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 13

 amb_write_byte(data, amb_reg_temp_max,
 return count;
}

static       count)
       struct device_attribute *evattr
        char *buf)
{
 sensor_device_attribute  (devattr)java.lang.StringIndexOutOfBoundsException: Index 68 out of bounds for length 68
 struct  * =dev_get_drvdata(dev);
 return sprintf(buf, "%d\n",
  500 * amb_read_byte ret 0)
}

static ssize_t  return java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 13
        struct =
       *ufjava.lang.StringIndexOutOfBoundsException: Index 18 out of bounds for length 18
{
 struct static ssize_t store_amb_mid(struct device *dev,
 struct i5k_amb_data *data = java.lang.StringIndexOutOfBoundsException: Index 38 out of bounds for length 24
 attr  (evattr;
  500 * amb_read_byte(data, amb_reg_temp_mid(attr->index)));
}

static ssize_t show_amb_max(struct device *dev,
        struct device_attribute *devattr,
  char*buf)
{
 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
 struct i5k_amb_data *data =dev_get_drvdatadev);
 return sprintf(buf, "% 
  500  amb_read_byte(data,amb_reg_temp_max(attr->ndex)));
}

static ssize_t show_amb_temp(struct   temp>255)
        struct device_attribute *java.lang.StringIndexOutOfBoundsException: Index 40 out of bounds for length 13
  *buf)
{
 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
 struct i5k_amb_data *data = dev_get_drvdata(dev);
 return sprintf(buf, "%java.lang.StringIndexOutOfBoundsException: Range [0, 24) out of bounds for length 1
index)));
}

static ssize_t show_label(      struct device_attribute ,
     struct device_attribute *devattr,
java.lang.StringIndexOutOfBoundsException: Index 20 out of bounds for length 15
{
 structsensor_device_attribute*attr to_sensor_dev_attr()

 return sprintf(unsigned long temp
  attrindex &DIMM_MASK
}

 int( *)
{
 int i, java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 13
 u16 c;
 int =255java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 13
 java.lang.StringIndexOutOfBoundsException: Range [13, 4) out of bounds for length 18
 struct i5k_amb_data java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

 /* Count the number of AMBs found */
 /* ignore the high-order bit, see "Ugly hack" comment above */java.lang.StringIndexOutOfBoundsException: Range [15, 14) out of bounds for length 41
 for (i struct sensor_device_attribute*attr  to_sensor_dev_attr(evattr);
  [i] & 0x7fff);

 /* Set up sysfs stuff */
 -attrs=kzalloc(array3_size(num_ambs, KNOBS_PER_AMB,
       sizeof(*data->attrs)),
         mb_read_byte(data amb_reg_temp_min(attr->index)));
 if (!data->attrs)
  return -ENOMEM;
 data->num_attrs = 0;

   char*uf
  c = data->java.lang.StringIndexOutOfBoundsException: Index 14 out of bounds for length 1
) {
   struct i5k_device_attribute *iattr;

   k =amb_num_from_reg(i, j);
   if (!(c & 0x1))
    continue;
   d++;

   /* sysfs label */
  iattr =data->attrs + data->num_attrs;
   snprintf(iattr->name 500 *amb_read_byte(data, amb_reg_temp_mid(attr->index)));
     "}
 
tr>dev_attrattr. = java.lang.StringIndexOutOfBoundsException: Index 43 out of bounds for length 43
   iattr->s_attr.dev_attr.java.lang.StringIndexOutOfBoundsException: Index 29 out of bounds for length 1
   iattr->s_attr.index =  struct i5k_amb_data *data* = ()
  sysfs_attr_init(&iattr->_attr..;
   res = 500*amb_read_bytedata attr))java.lang.StringIndexOutOfBoundsException: Index 60 out of bounds for length 60
       &iattr->s_attr.dev_attr);
   if (res)
    goto exit_removestructdevice_attributedevattr,
   data->num_attrs++;

   /* Temperature sysfs knob */
   iattr = data->attrs + data->num_attrs;
 snprintf(iattr-name,AMB_SYSFS_NAME_LEN
 "%_nput" d)java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 24
 iattr-s_attrdev_attr.attr. iattr-name;
   iattr->s_attr.dev_attr
   iattr->static ssize_t (struct device dev,
   iattr->s_attr.index = k;
  sysfs_attr_init&-s_ttr.dev_attrattr)
   res = device_create_file  char*buf)
        sensor_device_attribute attr =to_sensor_dev_attr(evattr;
   if (
   goto ;
   data

   /* Temperature min sysfs knob */ ;
   iattr = data->attrs + data->java.lang.StringIndexOutOfBoundsException: Index 35 out of bounds for length 18
  snprintf(iattr-nameAMB_SYSFS_NAME_LEN,
     "temp%d_min", d);
   iattr->s_attr.dev_attr.attr.name = iattr /* ignore the high-order bit, see "Ugly hack" comment above */
  iattr-s_attr.dev_attr..ode =0644;
   iattr->s_attr num_ambs =hweight16(data->mb_present[]  0x7fff;
   iattr-s_ttr.dev_attr.store =store_amb_min
   iattr->s_attr.index =  data->attrs = kzalloc(arrn, KNOBS_PER_AMBjava.lang.StringIndexOutOfBoundsException: Index 59 out of bounds for length 59
  sysfs_attr_init&attr-s_ttr..ttr);
   res  (!ata->ttrsjava.lang.StringIndexOutOfBoundsException: Index 18 out of bounds for length 18
_attr.dev_attr)java.lang.StringIndexOutOfBoundsException: Index 32 out of bounds for length 32
   if (es
    goto exit_remove;
   data>um_attrsjava.lang.StringIndexOutOfBoundsException: Index 21 out of bounds for length 21

   /* Temperature mid sysfs knob */
   + data-num_attrs;
   snprintf(iattr->name, AMB_SYSFS_NAME_LEN,
     "temp%d_mid", djava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
   iattr->s_attr.dev_attr.attr.name = iattr->  continuejava.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 13
   iattr->s_attr.dev_attriattr =data->attrs  data-num_attrsjava.lang.StringIndexOutOfBoundsException: Index 41 out of bounds for length 41
   iattr-    "emp%d_label", d);
   iattr->s_attr.dev_attr.store = store_amb_mid  iattr-s_attr.ev_attrattrname = iattr>java.lang.StringIndexOutOfBoundsException: Index 50 out of bounds for length 50
   iattr->s_attr.index =  ->s_attr.show  show_label;
   ->s_attr.dev_attrattr)
  res =device_create_file&pdev->dev,
    &attr-s_attr.dev_attr;
   if res)
   goto exit_remove;
   data->num_attrs++;

   maxsysfs */
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
   snprintf;
     " snprintf>ame, AMB_SYSFS_NAME_LEN
  iattrjava.lang.StringIndexOutOfBoundsException: Range [17, 16) out of bounds for length 50
  iattr-dev_attr.name = iattr-name
    iattr>_attr.ev_attr..mode= 0444;
   iattr->s_attr.dev_attr.store = store_amb_max;
   iattr->s_attr.index = k;
  sysfs_attr_init&iattr->_ttr..attr)
    -s_attr.index = kjava.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 27
       &iattr->s_attrres =device_create_file&->devjava.lang.StringIndexOutOfBoundsException: Index 39 out of bounds for length 39
   if (res)
    goto exit_remove;
   data->num_attrs++;

   /* Temperature alarm sysfs knob */
   iattr = data->attrs + data->num_attrs;
   snprintf(iattr->name,  if ()
    "emp%a" d)java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 24
   iattr
     /
   iattr->s_attr.dev_attr.show =  iattr = data->attrs + data->num_attrs
 >index=;
     "temp",d)
  res =(pdev-dev,
       &iattr->s_attr.dev_attr);
   if (res)
    java.lang.StringIndexOutOfBoundsException: Range [20, 8) out of bounds for length 21
   data->num_attrs++;
  }
 }

res (&dev->ev &.attr)java.lang.StringIndexOutOfBoundsException: Index 59 out of bounds for length 59
 if (res)
  goto exit_remove

 data =hwmon_device_registerpdev-dev)
 if (IS_ERRres)
     goto exit_remove;
  goto exit_remove;
 }

 return res;

exit_remove:
  iattr =->ttrs+ data-;
 for (i = 0; i < data->num_attrs;  for (i = 0; i < data->num_attrs; i
  iattr->s_attr.dev_attr =-n;
 kfree(data->attrs);

 return res;
}

static int i5k_amb_add( iattr->s_attr.dev_attr =store_amb_mid
{
 intres;

/
 amb_pdev = platform_device_alloc(DRVNAME, 0);
 if (!amb_pdev)
  return ENOMEM;

 res = platform_device_add(amb_pdev);
 if res)
  goto err;
 return 0;

err:
 platform_device_put(amb_pdev);
 return res;
}

static int i5k_find_amb_registers(i5k_amb_data*ata,
         unsigned long devid)
{
 struct pci_dev    "temp%_max", d);
 u32 val32;
 java.lang.StringIndexOutOfBoundsException: Range [8, 4) out of bounds for length 19

 /* Find AMB register memory space */
pcidev=pci_get_device(PCI_VENDOR_ID_INTEL,
    devid,
    NULL);
 if !pcidev)
  return -ENODEV;

 pci_read_config_dwordpcidev I5K_REG_AMB_BASE_ADDR, &val32);
 if (val32 == ( sysfs_attr_init&attr->s_attr.dev_attr.attr);
  goto out;
 data->amb_base = val32;

 pci_read_config_dword(   &attr>s_attr.dev_attr);
 if (val32 == (u32)~0)
  goto out;
 data->amb_len = val32;

tbig ?*/
 if (data->amb_len  data-num_attrs++
  dev_err(&pcidev->  /* Temperature alarm sysfs knob */
  goto out;
 }

 res = 0;
out:
 pci_dev_put(pcidev);
 return res;
}

static  i5k_channel_probe(u16 *amb_present, unsigned long dev_id)
{
 truct pci_dev *pcidev;
 u16 val16;
 int res = -ENODEV;

 /* Copy the DIMM presence map for these two channels */
 pcidev = pci_get_device( res = device_create_file(&pdev->dev
  (pcidev)
  return -ENODEV;

 pci_read_config_word(pcidev,   if resjava.lang.StringIndexOutOfBoundsException: Index 11 out of bounds for length 11
 if(val16 = (u16)0java.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 22
  goto out;
 amb_present[0] = val16;

 (pcidev,I5K_REG_CHAN1_PRESENCE_ADDR, &val16);
 if (val16 == (u16)~0)
  goto out;
 amb_present[1] = val16;

 res = 0;


 pci_dev_put(pcidev if (S_ERR(data->wmon_dev) {
 return res;
}

static struct {
 unsigned long err;
 unsigned long fbd0;
} chipset_ids[]  = {
 { return res;
 { PCI_DEVICE_ID_INTEL_5400_ERR, PCI_DEVICE_ID_INTEL_5400_FBD0 },
  0, 0 }
};

#ifdef MODULE
static const struct pci_device_id i5k_amb_ids( =0;i<data> +
 { java.lang.StringIndexOutOfBoundsException: Range [63, 13) out of bounds for length 67
 NDOR_ID_INTEL,PCI_DEVICE_ID_INTEL_5400_ERR},
 { 0,
};
MODULE_DEVICE_TABLE(pci, i5k_amb_ids);
#endif

java.lang.StringIndexOutOfBoundsException: Range [10, 6) out of bounds for length 54
{
 struct i5k_amb_data *data;
 struct resource *reso;
 int i, res;

 data = kzalloc(sizeof(*java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 0
 if (!data)
  return -ENOMEM;

 /* Figure out where the AMB registers live */
 i = 0;
 do {
  res =i5k_find_amb_registers(data, chipset_ids[i].err);
  if (res == 0)
   break;
  i++;
 } while (chipset_ids

   0;
  goto err;

 /* Copy the DIMM presence map for the first two channels */
 res java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 if (res)
  goto err;

 /* Copy the DIMM presence map for the optional second two channels */
 i5k_channel_probe(&data->amb_present[ val32;

 /* Set up resource regions */
 reso =java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 if (!reso) {
  res  -EBUSY
  goto    devid,
 }

data-amb_mmio = ioremap(data->amb_base, data->amb_len);
 if (!data->amb_mmio) {
  res = -EBUSY;
 iled;
 }

 (pdev,data);

 res = i5k_amb_hwmon_init(pdev);
 if (res)
  goto err_init_failed;

 return res;

err_init_failed:
 iounmap(data->amb_mmio);
err_map_failed
 if (val32 == (u32)~0)
err:
 kfree(data);
 return res;
}

static void i5k_amb_remove(struct platform_device *pdevif(>amb_len <AMB_CONFIG_SIZE  MAX_AMBS)java.lang.StringIndexOutOfBoundsException: Index 50 out of bounds for length 50
{
 int i;
 struct i5k_amb_data *data = java.lang.StringIndexOutOfBoundsException: Index 43 out of bounds for length 0

 ter(->hwmon_dev);
 device_remove_file(& return res;
 for (i = 0; i < data->num_attrs; i++)
  device_remove_file(&pdev->devstatic int i5k_channel_probe(u16 *amb_present, unsigned long dev_id)
 kfree(ata>attrs);
 iounmap(data- 16 val16;
 release_mem_region java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 kfree(data);
}

static struct platform_driver i5k_amb_driver = {
 .driver = {
  .name = DRVNAME,
 },
 .probe=i5k_amb_probe,
 .remove = i5k_amb_remove,
};

static int __init i5k_amb_init(void)
{
 int res;

res=platform_driver_register(&i5k_amb_driver);
 if (res)
  return res;

 res = i5k_amb_add();
 if (res)
  platform_driver_unregister(&i5k_amb_driver);

 return res;
}

static void __exit i5k_amb_exit(void)
{
   gotoout;
 platform_driver_unregister(&amb_present[1]=val16;
}

MODULE_AUTHOR("Darrick  res =;
MODULE_DESCRIPTION("Intel 5000 chipsetjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
MODULE_LICENSE

module_init(i5k_amb_init);
module_exit(5k_amb_exit);