1ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck/* 2ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Driver for the Texas Instruments / Burr Brown INA209 3ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Bidirectional Current/Power Monitor 4ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * 5ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Copyright (C) 2012 Guenter Roeck <linux@roeck-us.net> 6ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * 7ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Derived from Ira W. Snyder's original driver submission 8ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Copyright (C) 2008 Paul Hays <Paul.Hays@cattail.ca> 9ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Copyright (C) 2008-2009 Ira W. Snyder <iws@ovro.caltech.edu> 10ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * 11ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Aligned with ina2xx driver 12ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Copyright (C) 2012 Lothar Felten <l-felten@ti.com> 13ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Thanks to Jan Volkering 14ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * 15ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * This program is free software; you can redistribute it and/or modify 16ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * it under the terms of the GNU General Public License as published by 17ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * the Free Software Foundation; version 2 of the License. 18ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * 19ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Datasheet: 20ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * http://www.ti.com/lit/gpn/ina209 21ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck */ 22ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 23ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#include <linux/kernel.h> 24ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#include <linux/module.h> 25ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#include <linux/init.h> 26ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#include <linux/err.h> 27ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#include <linux/slab.h> 28ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#include <linux/bug.h> 29ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#include <linux/i2c.h> 30ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#include <linux/hwmon.h> 31ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#include <linux/hwmon-sysfs.h> 32ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 33ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#include <linux/platform_data/ina2xx.h> 34ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 35ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck/* register definitions */ 36ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_CONFIGURATION 0x00 37ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_STATUS 0x01 38ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_STATUS_MASK 0x02 39ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_SHUNT_VOLTAGE 0x03 40ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_BUS_VOLTAGE 0x04 41ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_POWER 0x05 42ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_CURRENT 0x06 43ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_SHUNT_VOLTAGE_POS_PEAK 0x07 44ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_SHUNT_VOLTAGE_NEG_PEAK 0x08 45ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_BUS_VOLTAGE_MAX_PEAK 0x09 46ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_BUS_VOLTAGE_MIN_PEAK 0x0a 47ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_POWER_PEAK 0x0b 48ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_SHUNT_VOLTAGE_POS_WARN 0x0c 49ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_SHUNT_VOLTAGE_NEG_WARN 0x0d 50ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_POWER_WARN 0x0e 51ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_BUS_VOLTAGE_OVER_WARN 0x0f 52ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_BUS_VOLTAGE_UNDER_WARN 0x10 53ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_POWER_OVER_LIMIT 0x11 54ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_BUS_VOLTAGE_OVER_LIMIT 0x12 55ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_BUS_VOLTAGE_UNDER_LIMIT 0x13 56ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_CRITICAL_DAC_POS 0x14 57ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_CRITICAL_DAC_NEG 0x15 58ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_CALIBRATION 0x16 59ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 60ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_REGISTERS 0x17 61ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 62ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_CONFIG_DEFAULT 0x3c47 /* PGA=8, full range */ 63ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck#define INA209_SHUNT_DEFAULT 10000 /* uOhm */ 64ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 65ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstruct ina209_data { 6689de734471c5381558b1e749e0b1b88b5b497708Guenter Roeck struct i2c_client *client; 67ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 68ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct mutex update_lock; 69ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck bool valid; 70ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck unsigned long last_updated; /* in jiffies */ 71ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 72ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck u16 regs[INA209_REGISTERS]; /* All chip registers */ 73ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 74ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck u16 config_orig; /* Original configuration */ 75ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck u16 calibration_orig; /* Original calibration */ 76ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck u16 update_interval; 77ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck}; 78ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 79ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic struct ina209_data *ina209_update_device(struct device *dev) 80ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck{ 8189de734471c5381558b1e749e0b1b88b5b497708Guenter Roeck struct ina209_data *data = dev_get_drvdata(dev); 8289de734471c5381558b1e749e0b1b88b5b497708Guenter Roeck struct i2c_client *client = data->client; 83ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct ina209_data *ret = data; 84ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck s32 val; 85ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck int i; 86ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 87ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck mutex_lock(&data->update_lock); 88ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 89ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (!data->valid || 90ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck time_after(jiffies, data->last_updated + data->update_interval)) { 91ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck for (i = 0; i < ARRAY_SIZE(data->regs); i++) { 92ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck val = i2c_smbus_read_word_swapped(client, i); 93ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (val < 0) { 94ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ret = ERR_PTR(val); 95ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck goto abort; 96ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck } 97ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck data->regs[i] = val; 98ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck } 99ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck data->last_updated = jiffies; 100ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck data->valid = true; 101ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck } 102ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckabort: 103ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck mutex_unlock(&data->update_lock); 104ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return ret; 105ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck} 106ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 107ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck/* 108ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Read a value from a device register and convert it to the 109ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * appropriate sysfs units 110ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck */ 111ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic long ina209_from_reg(const u8 reg, const u16 val) 112ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck{ 113ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck switch (reg) { 114ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_SHUNT_VOLTAGE: 115ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_SHUNT_VOLTAGE_POS_PEAK: 116ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_SHUNT_VOLTAGE_NEG_PEAK: 117ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_SHUNT_VOLTAGE_POS_WARN: 118ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_SHUNT_VOLTAGE_NEG_WARN: 119ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck /* LSB=10 uV. Convert to mV. */ 120ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return DIV_ROUND_CLOSEST(val, 100); 121ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 122ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_BUS_VOLTAGE: 123ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_BUS_VOLTAGE_MAX_PEAK: 124ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_BUS_VOLTAGE_MIN_PEAK: 125ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_BUS_VOLTAGE_OVER_WARN: 126ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_BUS_VOLTAGE_UNDER_WARN: 127ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_BUS_VOLTAGE_OVER_LIMIT: 128ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_BUS_VOLTAGE_UNDER_LIMIT: 129ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck /* LSB=4 mV, last 3 bits unused */ 130ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return (val >> 3) * 4; 131ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 132ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_CRITICAL_DAC_POS: 133ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck /* LSB=1 mV, in the upper 8 bits */ 134ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return val >> 8; 135ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 136ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_CRITICAL_DAC_NEG: 137ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck /* LSB=1 mV, in the upper 8 bits */ 138ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return -1 * (val >> 8); 139ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 140ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_POWER: 141ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_POWER_PEAK: 142ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_POWER_WARN: 143ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_POWER_OVER_LIMIT: 144ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck /* LSB=20 mW. Convert to uW */ 145ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return val * 20 * 1000L; 146ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 147ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_CURRENT: 148ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck /* LSB=1 mA (selected). Is in mA */ 149ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return val; 150ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck } 151ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 152ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck /* programmer goofed */ 153ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck WARN_ON_ONCE(1); 154ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return 0; 155ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck} 156ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 157ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck/* 158ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Take a value and convert it to register format, clamping the value 159ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * to the appropriate range. 160ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck */ 161ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic int ina209_to_reg(u8 reg, u16 old, long val) 162ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck{ 163ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck switch (reg) { 164ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_SHUNT_VOLTAGE_POS_WARN: 165ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_SHUNT_VOLTAGE_NEG_WARN: 166ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck /* Limit to +- 320 mV, 10 uV LSB */ 167ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return clamp_val(val, -320, 320) * 100; 168ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 169ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_BUS_VOLTAGE_OVER_WARN: 170ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_BUS_VOLTAGE_UNDER_WARN: 171ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_BUS_VOLTAGE_OVER_LIMIT: 172ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_BUS_VOLTAGE_UNDER_LIMIT: 173ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck /* 174ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Limit to 0-32000 mV, 4 mV LSB 175ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * 176ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * The last three bits aren't part of the value, but we'll 177ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * preserve them in their original state. 178ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck */ 179ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return (DIV_ROUND_CLOSEST(clamp_val(val, 0, 32000), 4) << 3) 180ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck | (old & 0x7); 181ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 182ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_CRITICAL_DAC_NEG: 183ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck /* 184ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Limit to -255-0 mV, 1 mV LSB 185ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Convert the value to a positive value for the register 186ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * 187ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * The value lives in the top 8 bits only, be careful 188ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * and keep original value of other bits. 189ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck */ 190ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return (clamp_val(-val, 0, 255) << 8) | (old & 0xff); 191ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 192ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_CRITICAL_DAC_POS: 193ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck /* 194ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Limit to 0-255 mV, 1 mV LSB 195ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * 196ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * The value lives in the top 8 bits only, be careful 197ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * and keep original value of other bits. 198ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck */ 199ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return (clamp_val(val, 0, 255) << 8) | (old & 0xff); 200ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 201ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_POWER_WARN: 202ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck case INA209_POWER_OVER_LIMIT: 203ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck /* 20 mW LSB */ 204ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return DIV_ROUND_CLOSEST(val, 20 * 1000); 205ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck } 206ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 207ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck /* Other registers are read-only, return access error */ 208ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return -EACCES; 209ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck} 210ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 211ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic int ina209_interval_from_reg(u16 reg) 212ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck{ 213ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return 68 >> (15 - ((reg >> 3) & 0x0f)); 214ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck} 215ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 216ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic u16 ina209_reg_from_interval(u16 config, long interval) 217ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck{ 218ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck int i, adc; 219ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 220ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (interval <= 0) { 221ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck adc = 8; 222ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck } else { 223ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck adc = 15; 224ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck for (i = 34 + 34 / 2; i; i >>= 1) { 225ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (i < interval) 226ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck break; 227ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck adc--; 228ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck } 229ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck } 230ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return (config & 0xf807) | (adc << 3) | (adc << 7); 231ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck} 232ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 233ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic ssize_t ina209_set_interval(struct device *dev, 234ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct device_attribute *da, 235ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck const char *buf, size_t count) 236ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck{ 237ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct ina209_data *data = ina209_update_device(dev); 238ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck long val; 239ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck u16 regval; 240ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck int ret; 241ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 242ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (IS_ERR(data)) 243ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return PTR_ERR(data); 244ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 245ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ret = kstrtol(buf, 10, &val); 246ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (ret < 0) 247ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return ret; 248ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 249ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck mutex_lock(&data->update_lock); 250ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck regval = ina209_reg_from_interval(data->regs[INA209_CONFIGURATION], 251ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck val); 25289de734471c5381558b1e749e0b1b88b5b497708Guenter Roeck i2c_smbus_write_word_swapped(data->client, INA209_CONFIGURATION, 25389de734471c5381558b1e749e0b1b88b5b497708Guenter Roeck regval); 254ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck data->regs[INA209_CONFIGURATION] = regval; 255ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck data->update_interval = ina209_interval_from_reg(regval); 256ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck mutex_unlock(&data->update_lock); 257ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return count; 258ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck} 259ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 260ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic ssize_t ina209_show_interval(struct device *dev, 261ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct device_attribute *da, char *buf) 262ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck{ 26389de734471c5381558b1e749e0b1b88b5b497708Guenter Roeck struct ina209_data *data = dev_get_drvdata(dev); 264ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 265ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return snprintf(buf, PAGE_SIZE, "%d\n", data->update_interval); 266ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck} 267ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 268ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck/* 269ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * History is reset by writing 1 into bit 0 of the respective peak register. 270ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Since more than one peak register may be affected by the scope of a 271ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * reset_history attribute write, use a bit mask in attr->index to identify 272ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * which registers are affected. 273ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck */ 274ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic u16 ina209_reset_history_regs[] = { 275ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck INA209_SHUNT_VOLTAGE_POS_PEAK, 276ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck INA209_SHUNT_VOLTAGE_NEG_PEAK, 277ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck INA209_BUS_VOLTAGE_MAX_PEAK, 278ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck INA209_BUS_VOLTAGE_MIN_PEAK, 279ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck INA209_POWER_PEAK 280ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck}; 281ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 282ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic ssize_t ina209_reset_history(struct device *dev, 283ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct device_attribute *da, 284ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck const char *buf, 285ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck size_t count) 286ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck{ 287ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct sensor_device_attribute *attr = to_sensor_dev_attr(da); 28889de734471c5381558b1e749e0b1b88b5b497708Guenter Roeck struct ina209_data *data = dev_get_drvdata(dev); 28989de734471c5381558b1e749e0b1b88b5b497708Guenter Roeck struct i2c_client *client = data->client; 290ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck u32 mask = attr->index; 291ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck long val; 292ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck int i, ret; 293ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 294ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ret = kstrtol(buf, 10, &val); 295ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (ret < 0) 296ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return ret; 297ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 298ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck mutex_lock(&data->update_lock); 299ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck for (i = 0; i < ARRAY_SIZE(ina209_reset_history_regs); i++) { 300ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (mask & (1 << i)) 301ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck i2c_smbus_write_word_swapped(client, 302ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ina209_reset_history_regs[i], 1); 303ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck } 304ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck data->valid = false; 305ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck mutex_unlock(&data->update_lock); 306ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return count; 307ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck} 308ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 309ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic ssize_t ina209_set_value(struct device *dev, 310ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct device_attribute *da, 311ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck const char *buf, 312ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck size_t count) 313ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck{ 314ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct ina209_data *data = ina209_update_device(dev); 315ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct sensor_device_attribute *attr = to_sensor_dev_attr(da); 316ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck int reg = attr->index; 317ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck long val; 318ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck int ret; 319ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 320ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (IS_ERR(data)) 321ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return PTR_ERR(data); 322ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 323ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ret = kstrtol(buf, 10, &val); 324ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (ret < 0) 325ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return ret; 326ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 327ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck mutex_lock(&data->update_lock); 328ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ret = ina209_to_reg(reg, data->regs[reg], val); 329ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (ret < 0) { 330ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck count = ret; 331ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck goto abort; 332ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck } 33389de734471c5381558b1e749e0b1b88b5b497708Guenter Roeck i2c_smbus_write_word_swapped(data->client, reg, ret); 334ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck data->regs[reg] = ret; 335ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckabort: 336ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck mutex_unlock(&data->update_lock); 337ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return count; 338ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck} 339ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 340ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic ssize_t ina209_show_value(struct device *dev, 341ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct device_attribute *da, 342ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck char *buf) 343ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck{ 344ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct sensor_device_attribute *attr = to_sensor_dev_attr(da); 345ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct ina209_data *data = ina209_update_device(dev); 346ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck long val; 347ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 348ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (IS_ERR(data)) 349ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return PTR_ERR(data); 350ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 351ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck val = ina209_from_reg(attr->index, data->regs[attr->index]); 352ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return snprintf(buf, PAGE_SIZE, "%ld\n", val); 353ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck} 354ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 355ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic ssize_t ina209_show_alarm(struct device *dev, 356ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct device_attribute *da, 357ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck char *buf) 358ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck{ 359ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct sensor_device_attribute *attr = to_sensor_dev_attr(da); 360ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct ina209_data *data = ina209_update_device(dev); 361ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck const unsigned int mask = attr->index; 362ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck u16 status; 363ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 364ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (IS_ERR(data)) 365ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return PTR_ERR(data); 366ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 367ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck status = data->regs[INA209_STATUS]; 368ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 369ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck /* 370ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * All alarms are in the INA209_STATUS register. To avoid a long 371ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * switch statement, the mask is passed in attr->index 372ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck */ 373ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return snprintf(buf, PAGE_SIZE, "%u\n", !!(status & mask)); 374ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck} 375ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 376ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck/* Shunt voltage, history, limits, alarms */ 377ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in0_input, S_IRUGO, ina209_show_value, NULL, 378ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck INA209_SHUNT_VOLTAGE); 379ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in0_input_highest, S_IRUGO, ina209_show_value, NULL, 380ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck INA209_SHUNT_VOLTAGE_POS_PEAK); 381ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in0_input_lowest, S_IRUGO, ina209_show_value, NULL, 382ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck INA209_SHUNT_VOLTAGE_NEG_PEAK); 383ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in0_reset_history, S_IWUSR, NULL, 384ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ina209_reset_history, (1 << 0) | (1 << 1)); 385ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in0_max, S_IRUGO | S_IWUSR, ina209_show_value, 386ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ina209_set_value, INA209_SHUNT_VOLTAGE_POS_WARN); 387ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in0_min, S_IRUGO | S_IWUSR, ina209_show_value, 388ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ina209_set_value, INA209_SHUNT_VOLTAGE_NEG_WARN); 389ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in0_crit_max, S_IRUGO | S_IWUSR, ina209_show_value, 390ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ina209_set_value, INA209_CRITICAL_DAC_POS); 391ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in0_crit_min, S_IRUGO | S_IWUSR, ina209_show_value, 392ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ina209_set_value, INA209_CRITICAL_DAC_NEG); 393ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 394ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in0_min_alarm, S_IRUGO, ina209_show_alarm, NULL, 395ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 1 << 11); 396ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in0_max_alarm, S_IRUGO, ina209_show_alarm, NULL, 397ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 1 << 12); 398ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in0_crit_min_alarm, S_IRUGO, ina209_show_alarm, NULL, 399ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 1 << 6); 400ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in0_crit_max_alarm, S_IRUGO, ina209_show_alarm, NULL, 401ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 1 << 7); 402ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 403ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck/* Bus voltage, history, limits, alarms */ 404ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in1_input, S_IRUGO, ina209_show_value, NULL, 405ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck INA209_BUS_VOLTAGE); 406ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in1_input_highest, S_IRUGO, ina209_show_value, NULL, 407ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck INA209_BUS_VOLTAGE_MAX_PEAK); 408ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in1_input_lowest, S_IRUGO, ina209_show_value, NULL, 409ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck INA209_BUS_VOLTAGE_MIN_PEAK); 410ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in1_reset_history, S_IWUSR, NULL, 411ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ina209_reset_history, (1 << 2) | (1 << 3)); 412ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in1_max, S_IRUGO | S_IWUSR, ina209_show_value, 413ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ina209_set_value, INA209_BUS_VOLTAGE_OVER_WARN); 414ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in1_min, S_IRUGO | S_IWUSR, ina209_show_value, 415ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ina209_set_value, INA209_BUS_VOLTAGE_UNDER_WARN); 416ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in1_crit_max, S_IRUGO | S_IWUSR, ina209_show_value, 417ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ina209_set_value, INA209_BUS_VOLTAGE_OVER_LIMIT); 418ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in1_crit_min, S_IRUGO | S_IWUSR, ina209_show_value, 419ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ina209_set_value, INA209_BUS_VOLTAGE_UNDER_LIMIT); 420ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 421ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in1_min_alarm, S_IRUGO, ina209_show_alarm, NULL, 422ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 1 << 14); 423ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in1_max_alarm, S_IRUGO, ina209_show_alarm, NULL, 424ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 1 << 15); 425ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in1_crit_min_alarm, S_IRUGO, ina209_show_alarm, NULL, 426ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 1 << 9); 427ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(in1_crit_max_alarm, S_IRUGO, ina209_show_alarm, NULL, 428ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 1 << 10); 429ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 430ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck/* Power */ 431ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(power1_input, S_IRUGO, ina209_show_value, NULL, 432ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck INA209_POWER); 433ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(power1_input_highest, S_IRUGO, ina209_show_value, 434ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck NULL, INA209_POWER_PEAK); 435ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(power1_reset_history, S_IWUSR, NULL, 436ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ina209_reset_history, 1 << 4); 437ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(power1_max, S_IRUGO | S_IWUSR, ina209_show_value, 438ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ina209_set_value, INA209_POWER_WARN); 439ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(power1_crit, S_IRUGO | S_IWUSR, ina209_show_value, 440ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ina209_set_value, INA209_POWER_OVER_LIMIT); 441ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 442ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(power1_max_alarm, S_IRUGO, ina209_show_alarm, NULL, 443ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 1 << 13); 444ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(power1_crit_alarm, S_IRUGO, ina209_show_alarm, NULL, 445ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 1 << 8); 446ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 447ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck/* Current */ 448ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(curr1_input, S_IRUGO, ina209_show_value, NULL, 449ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck INA209_CURRENT); 450ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 451ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic SENSOR_DEVICE_ATTR(update_interval, S_IRUGO | S_IWUSR, 452ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ina209_show_interval, ina209_set_interval, 0); 453ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 454ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck/* 455ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Finally, construct an array of pointers to members of the above objects, 456ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * as required for sysfs_create_group() 457ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck */ 45889de734471c5381558b1e749e0b1b88b5b497708Guenter Roeckstatic struct attribute *ina209_attrs[] = { 459ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in0_input.dev_attr.attr, 460ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in0_input_highest.dev_attr.attr, 461ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in0_input_lowest.dev_attr.attr, 462ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in0_reset_history.dev_attr.attr, 463ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in0_max.dev_attr.attr, 464ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in0_min.dev_attr.attr, 465ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in0_crit_max.dev_attr.attr, 466ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in0_crit_min.dev_attr.attr, 467ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in0_max_alarm.dev_attr.attr, 468ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in0_min_alarm.dev_attr.attr, 469ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in0_crit_max_alarm.dev_attr.attr, 470ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in0_crit_min_alarm.dev_attr.attr, 471ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 472ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in1_input.dev_attr.attr, 473ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in1_input_highest.dev_attr.attr, 474ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in1_input_lowest.dev_attr.attr, 475ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in1_reset_history.dev_attr.attr, 476ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in1_max.dev_attr.attr, 477ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in1_min.dev_attr.attr, 478ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in1_crit_max.dev_attr.attr, 479ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in1_crit_min.dev_attr.attr, 480ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in1_max_alarm.dev_attr.attr, 481ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in1_min_alarm.dev_attr.attr, 482ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in1_crit_max_alarm.dev_attr.attr, 483ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_in1_crit_min_alarm.dev_attr.attr, 484ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 485ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_power1_input.dev_attr.attr, 486ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_power1_input_highest.dev_attr.attr, 487ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_power1_reset_history.dev_attr.attr, 488ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_power1_max.dev_attr.attr, 489ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_power1_crit.dev_attr.attr, 490ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_power1_max_alarm.dev_attr.attr, 491ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_power1_crit_alarm.dev_attr.attr, 492ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 493ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_curr1_input.dev_attr.attr, 494ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 495ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &sensor_dev_attr_update_interval.dev_attr.attr, 496ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 497ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck NULL, 498ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck}; 49989de734471c5381558b1e749e0b1b88b5b497708Guenter RoeckATTRIBUTE_GROUPS(ina209); 500ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 501ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic void ina209_restore_conf(struct i2c_client *client, 502ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct ina209_data *data) 503ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck{ 504ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck /* Restore initial configuration */ 505ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck i2c_smbus_write_word_swapped(client, INA209_CONFIGURATION, 506ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck data->config_orig); 507ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck i2c_smbus_write_word_swapped(client, INA209_CALIBRATION, 508ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck data->calibration_orig); 509ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck} 510ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 511ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic int ina209_init_client(struct i2c_client *client, 512ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct ina209_data *data) 513ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck{ 514ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct ina2xx_platform_data *pdata = dev_get_platdata(&client->dev); 515ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck u32 shunt; 516ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck int reg; 517ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 518ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck reg = i2c_smbus_read_word_swapped(client, INA209_CALIBRATION); 519ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (reg < 0) 520ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return reg; 521ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck data->calibration_orig = reg; 522ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 523ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck reg = i2c_smbus_read_word_swapped(client, INA209_CONFIGURATION); 524ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (reg < 0) 525ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return reg; 526ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck data->config_orig = reg; 527ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 528ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (pdata) { 529ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (pdata->shunt_uohms <= 0) 530ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return -EINVAL; 531ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck shunt = pdata->shunt_uohms; 532ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck } else if (!of_property_read_u32(client->dev.of_node, "shunt-resistor", 533ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck &shunt)) { 534ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (shunt == 0) 535ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return -EINVAL; 536ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck } else { 537ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck shunt = data->calibration_orig ? 538ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 40960000 / data->calibration_orig : INA209_SHUNT_DEFAULT; 539ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck } 540ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 541ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck i2c_smbus_write_word_swapped(client, INA209_CONFIGURATION, 542ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck INA209_CONFIG_DEFAULT); 543ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck data->update_interval = ina209_interval_from_reg(INA209_CONFIG_DEFAULT); 544ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 545ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck /* 546ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * Calibrate current LSB to 1mA. Shunt is in uOhms. 547ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck * See equation 13 in datasheet. 548ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck */ 549ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck i2c_smbus_write_word_swapped(client, INA209_CALIBRATION, 550ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck clamp_val(40960000 / shunt, 1, 65535)); 551ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 552ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck /* Clear status register */ 553ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck i2c_smbus_read_word_swapped(client, INA209_STATUS); 554ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 555ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return 0; 556ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck} 557ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 558ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic int ina209_probe(struct i2c_client *client, 559ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck const struct i2c_device_id *id) 560ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck{ 561ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct i2c_adapter *adapter = client->adapter; 562ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct ina209_data *data; 56389de734471c5381558b1e749e0b1b88b5b497708Guenter Roeck struct device *hwmon_dev; 564ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck int ret; 565ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 566ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_WORD_DATA)) 567ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return -ENODEV; 568ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 569ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck data = devm_kzalloc(&client->dev, sizeof(*data), GFP_KERNEL); 570ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (!data) 571ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return -ENOMEM; 572ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 573ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck i2c_set_clientdata(client, data); 57489de734471c5381558b1e749e0b1b88b5b497708Guenter Roeck data->client = client; 575ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck mutex_init(&data->update_lock); 576ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 577ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ret = ina209_init_client(client, data); 578ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck if (ret) 579ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return ret; 580ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 58189de734471c5381558b1e749e0b1b88b5b497708Guenter Roeck hwmon_dev = devm_hwmon_device_register_with_groups(&client->dev, 58289de734471c5381558b1e749e0b1b88b5b497708Guenter Roeck client->name, 58389de734471c5381558b1e749e0b1b88b5b497708Guenter Roeck data, ina209_groups); 58489de734471c5381558b1e749e0b1b88b5b497708Guenter Roeck if (IS_ERR(hwmon_dev)) { 58589de734471c5381558b1e749e0b1b88b5b497708Guenter Roeck ret = PTR_ERR(hwmon_dev); 586ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck goto out_restore_conf; 587ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck } 588ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 589ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return 0; 590ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 591ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckout_restore_conf: 592ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ina209_restore_conf(client, data); 593ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return ret; 594ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck} 595ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 596ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic int ina209_remove(struct i2c_client *client) 597ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck{ 598ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck struct ina209_data *data = i2c_get_clientdata(client); 599ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 600ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck ina209_restore_conf(client, data); 601ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 602ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck return 0; 603ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck} 604ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 605ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic const struct i2c_device_id ina209_id[] = { 606ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck { "ina209", 0 }, 607ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck { } 608ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck}; 609ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter RoeckMODULE_DEVICE_TABLE(i2c, ina209_id); 610ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 611ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck/* This is the driver that will be inserted */ 612ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckstatic struct i2c_driver ina209_driver = { 613ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck .class = I2C_CLASS_HWMON, 614ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck .driver = { 615ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck .name = "ina209", 616ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck }, 617ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck .probe = ina209_probe, 618ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck .remove = ina209_remove, 619ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck .id_table = ina209_id, 620ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck}; 621ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 622ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeckmodule_i2c_driver(ina209_driver); 623ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter Roeck 624ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter RoeckMODULE_AUTHOR("Ira W. Snyder <iws@ovro.caltech.edu>, Paul Hays <Paul.Hays@cattail.ca>, Guenter Roeck <linux@roeck-us.net>"); 625ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter RoeckMODULE_DESCRIPTION("INA209 driver"); 626ceeadc5c5187b78ffbea737c7a82ecc1e31e80dfGuenter RoeckMODULE_LICENSE("GPL"); 627