1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831 |
- #include <linux/module.h>
- #include <linux/init.h>
- #include <linux/slab.h>
- #include <linux/jiffies.h>
- #include <linux/i2c.h>
- #include <linux/hwmon.h>
- #include <linux/err.h>
- #include <linux/mutex.h>
- #include <linux/sysfs.h>
- #include <linux/interrupt.h>
- #include <linux/regulator/consumer.h>
- static const unsigned short normal_i2c[] = {
- 0x18, 0x19, 0x1a, 0x29, 0x2a, 0x2b, 0x48, 0x49, 0x4a, 0x4b, 0x4c,
- 0x4d, 0x4e, 0x4f, I2C_CLIENT_END };
- enum chips { lm90, adm1032, lm99, lm86, max6657, max6659, adt7461, max6680,
- max6646, w83l771, max6696, sa56004, g781, tmp451 };
- #define LM90_REG_R_MAN_ID 0xFE
- #define LM90_REG_R_CHIP_ID 0xFF
- #define LM90_REG_R_CONFIG1 0x03
- #define LM90_REG_W_CONFIG1 0x09
- #define LM90_REG_R_CONFIG2 0xBF
- #define LM90_REG_W_CONFIG2 0xBF
- #define LM90_REG_R_CONVRATE 0x04
- #define LM90_REG_W_CONVRATE 0x0A
- #define LM90_REG_R_STATUS 0x02
- #define LM90_REG_R_LOCAL_TEMP 0x00
- #define LM90_REG_R_LOCAL_HIGH 0x05
- #define LM90_REG_W_LOCAL_HIGH 0x0B
- #define LM90_REG_R_LOCAL_LOW 0x06
- #define LM90_REG_W_LOCAL_LOW 0x0C
- #define LM90_REG_R_LOCAL_CRIT 0x20
- #define LM90_REG_W_LOCAL_CRIT 0x20
- #define LM90_REG_R_REMOTE_TEMPH 0x01
- #define LM90_REG_R_REMOTE_TEMPL 0x10
- #define LM90_REG_R_REMOTE_OFFSH 0x11
- #define LM90_REG_W_REMOTE_OFFSH 0x11
- #define LM90_REG_R_REMOTE_OFFSL 0x12
- #define LM90_REG_W_REMOTE_OFFSL 0x12
- #define LM90_REG_R_REMOTE_HIGHH 0x07
- #define LM90_REG_W_REMOTE_HIGHH 0x0D
- #define LM90_REG_R_REMOTE_HIGHL 0x13
- #define LM90_REG_W_REMOTE_HIGHL 0x13
- #define LM90_REG_R_REMOTE_LOWH 0x08
- #define LM90_REG_W_REMOTE_LOWH 0x0E
- #define LM90_REG_R_REMOTE_LOWL 0x14
- #define LM90_REG_W_REMOTE_LOWL 0x14
- #define LM90_REG_R_REMOTE_CRIT 0x19
- #define LM90_REG_W_REMOTE_CRIT 0x19
- #define LM90_REG_R_TCRIT_HYST 0x21
- #define LM90_REG_W_TCRIT_HYST 0x21
- #define MAX6657_REG_R_LOCAL_TEMPL 0x11
- #define MAX6696_REG_R_STATUS2 0x12
- #define MAX6659_REG_R_REMOTE_EMERG 0x16
- #define MAX6659_REG_W_REMOTE_EMERG 0x16
- #define MAX6659_REG_R_LOCAL_EMERG 0x17
- #define MAX6659_REG_W_LOCAL_EMERG 0x17
- #define SA56004_REG_R_LOCAL_TEMPL 0x22
- #define LM90_MAX_CONVRATE_MS 16000
- #define TMP451_REG_R_LOCAL_TEMPL 0x15
- #define LM90_FLAG_ADT7461_EXT (1 << 0)
- #define LM90_HAVE_OFFSET (1 << 1)
- #define LM90_HAVE_REM_LIMIT_EXT (1 << 3)
- #define LM90_HAVE_EMERGENCY (1 << 4)
- #define LM90_HAVE_EMERGENCY_ALARM (1 << 5)
- #define LM90_HAVE_TEMP3 (1 << 6)
- #define LM90_HAVE_BROKEN_ALERT (1 << 7)
- #define LM90_STATUS_LTHRM (1 << 0)
- #define LM90_STATUS_RTHRM (1 << 1)
- #define LM90_STATUS_ROPEN (1 << 2)
- #define LM90_STATUS_RLOW (1 << 3)
- #define LM90_STATUS_RHIGH (1 << 4)
- #define LM90_STATUS_LLOW (1 << 5)
- #define LM90_STATUS_LHIGH (1 << 6)
- #define MAX6696_STATUS2_R2THRM (1 << 1)
- #define MAX6696_STATUS2_R2OPEN (1 << 2)
- #define MAX6696_STATUS2_R2LOW (1 << 3)
- #define MAX6696_STATUS2_R2HIGH (1 << 4)
- #define MAX6696_STATUS2_ROT2 (1 << 5)
- #define MAX6696_STATUS2_R2OT2 (1 << 6)
- #define MAX6696_STATUS2_LOT2 (1 << 7)
- static const struct i2c_device_id lm90_id[] = {
- { "adm1032", adm1032 },
- { "adt7461", adt7461 },
- { "adt7461a", adt7461 },
- { "g781", g781 },
- { "lm90", lm90 },
- { "lm86", lm86 },
- { "lm89", lm86 },
- { "lm99", lm99 },
- { "max6646", max6646 },
- { "max6647", max6646 },
- { "max6649", max6646 },
- { "max6657", max6657 },
- { "max6658", max6657 },
- { "max6659", max6659 },
- { "max6680", max6680 },
- { "max6681", max6680 },
- { "max6695", max6696 },
- { "max6696", max6696 },
- { "nct1008", adt7461 },
- { "w83l771", w83l771 },
- { "sa56004", sa56004 },
- { "tmp451", tmp451 },
- { }
- };
- MODULE_DEVICE_TABLE(i2c, lm90_id);
- struct lm90_params {
- u32 flags;
- u16 alert_alarms;
-
- u8 max_convrate;
- u8 reg_local_ext;
- };
- static const struct lm90_params lm90_params[] = {
- [adm1032] = {
- .flags = LM90_HAVE_OFFSET | LM90_HAVE_REM_LIMIT_EXT
- | LM90_HAVE_BROKEN_ALERT,
- .alert_alarms = 0x7c,
- .max_convrate = 10,
- },
- [adt7461] = {
- .flags = LM90_HAVE_OFFSET | LM90_HAVE_REM_LIMIT_EXT
- | LM90_HAVE_BROKEN_ALERT,
- .alert_alarms = 0x7c,
- .max_convrate = 10,
- },
- [g781] = {
- .flags = LM90_HAVE_OFFSET | LM90_HAVE_REM_LIMIT_EXT
- | LM90_HAVE_BROKEN_ALERT,
- .alert_alarms = 0x7c,
- .max_convrate = 8,
- },
- [lm86] = {
- .flags = LM90_HAVE_OFFSET | LM90_HAVE_REM_LIMIT_EXT,
- .alert_alarms = 0x7b,
- .max_convrate = 9,
- },
- [lm90] = {
- .flags = LM90_HAVE_OFFSET | LM90_HAVE_REM_LIMIT_EXT,
- .alert_alarms = 0x7b,
- .max_convrate = 9,
- },
- [lm99] = {
- .flags = LM90_HAVE_OFFSET | LM90_HAVE_REM_LIMIT_EXT,
- .alert_alarms = 0x7b,
- .max_convrate = 9,
- },
- [max6646] = {
- .alert_alarms = 0x7c,
- .max_convrate = 6,
- .reg_local_ext = MAX6657_REG_R_LOCAL_TEMPL,
- },
- [max6657] = {
- .alert_alarms = 0x7c,
- .max_convrate = 8,
- .reg_local_ext = MAX6657_REG_R_LOCAL_TEMPL,
- },
- [max6659] = {
- .flags = LM90_HAVE_EMERGENCY,
- .alert_alarms = 0x7c,
- .max_convrate = 8,
- .reg_local_ext = MAX6657_REG_R_LOCAL_TEMPL,
- },
- [max6680] = {
- .flags = LM90_HAVE_OFFSET,
- .alert_alarms = 0x7c,
- .max_convrate = 7,
- },
- [max6696] = {
- .flags = LM90_HAVE_EMERGENCY
- | LM90_HAVE_EMERGENCY_ALARM | LM90_HAVE_TEMP3,
- .alert_alarms = 0x1c7c,
- .max_convrate = 6,
- .reg_local_ext = MAX6657_REG_R_LOCAL_TEMPL,
- },
- [w83l771] = {
- .flags = LM90_HAVE_OFFSET | LM90_HAVE_REM_LIMIT_EXT,
- .alert_alarms = 0x7c,
- .max_convrate = 8,
- },
- [sa56004] = {
- .flags = LM90_HAVE_OFFSET | LM90_HAVE_REM_LIMIT_EXT,
- .alert_alarms = 0x7b,
- .max_convrate = 9,
- .reg_local_ext = SA56004_REG_R_LOCAL_TEMPL,
- },
- [tmp451] = {
- .flags = LM90_HAVE_OFFSET | LM90_HAVE_REM_LIMIT_EXT
- | LM90_HAVE_BROKEN_ALERT,
- .alert_alarms = 0x7c,
- .max_convrate = 9,
- .reg_local_ext = TMP451_REG_R_LOCAL_TEMPL,
- },
- };
- enum lm90_temp8_reg_index {
- LOCAL_LOW = 0,
- LOCAL_HIGH,
- LOCAL_CRIT,
- REMOTE_CRIT,
- LOCAL_EMERG,
- REMOTE_EMERG,
- REMOTE2_CRIT,
- REMOTE2_EMERG,
- TEMP8_REG_NUM
- };
- enum lm90_temp11_reg_index {
- REMOTE_TEMP = 0,
- REMOTE_LOW,
- REMOTE_HIGH,
- REMOTE_OFFSET,
- LOCAL_TEMP,
- REMOTE2_TEMP,
- REMOTE2_LOW,
- REMOTE2_HIGH,
- TEMP11_REG_NUM
- };
- struct lm90_data {
- struct i2c_client *client;
- u32 channel_config[4];
- struct hwmon_channel_info temp_info;
- const struct hwmon_channel_info *info[3];
- struct hwmon_chip_info chip;
- struct mutex update_lock;
- bool valid;
- unsigned long last_updated;
- int kind;
- u32 flags;
- unsigned int update_interval;
- u8 config_orig;
- u8 convrate_orig;
- u16 alert_alarms;
-
- u8 max_convrate;
- u8 reg_local_ext;
-
- s8 temp8[TEMP8_REG_NUM];
- s16 temp11[TEMP11_REG_NUM];
- u8 temp_hyst;
- u16 alarms;
- };
- static inline s32 adm1032_write_byte(struct i2c_client *client, u8 value)
- {
- return i2c_smbus_xfer(client->adapter, client->addr,
- client->flags & ~I2C_CLIENT_PEC,
- I2C_SMBUS_WRITE, value, I2C_SMBUS_BYTE, NULL);
- }
- static int lm90_read_reg(struct i2c_client *client, u8 reg)
- {
- int err;
- if (client->flags & I2C_CLIENT_PEC) {
- err = adm1032_write_byte(client, reg);
- if (err >= 0)
- err = i2c_smbus_read_byte(client);
- } else
- err = i2c_smbus_read_byte_data(client, reg);
- return err;
- }
- static int lm90_read16(struct i2c_client *client, u8 regh, u8 regl)
- {
- int oldh, newh, l;
-
- oldh = lm90_read_reg(client, regh);
- if (oldh < 0)
- return oldh;
- l = lm90_read_reg(client, regl);
- if (l < 0)
- return l;
- newh = lm90_read_reg(client, regh);
- if (newh < 0)
- return newh;
- if (oldh != newh) {
- l = lm90_read_reg(client, regl);
- if (l < 0)
- return l;
- }
- return (newh << 8) | l;
- }
- static inline int lm90_select_remote_channel(struct i2c_client *client,
- struct lm90_data *data,
- int channel)
- {
- int config;
- if (data->kind == max6696) {
- config = lm90_read_reg(client, LM90_REG_R_CONFIG1);
- if (config < 0)
- return config;
- config &= ~0x08;
- if (channel)
- config |= 0x08;
- i2c_smbus_write_byte_data(client, LM90_REG_W_CONFIG1,
- config);
- }
- return 0;
- }
- static int lm90_set_convrate(struct i2c_client *client, struct lm90_data *data,
- unsigned int interval)
- {
- unsigned int update_interval;
- int i, err;
-
- interval <<= 6;
-
- for (i = 0, update_interval = LM90_MAX_CONVRATE_MS << 6;
- i < data->max_convrate; i++, update_interval >>= 1)
- if (interval >= update_interval * 3 / 4)
- break;
- err = i2c_smbus_write_byte_data(client, LM90_REG_W_CONVRATE, i);
- data->update_interval = DIV_ROUND_CLOSEST(update_interval, 64);
- return err;
- }
- static int lm90_update_limits(struct device *dev)
- {
- struct lm90_data *data = dev_get_drvdata(dev);
- struct i2c_client *client = data->client;
- int val;
- val = lm90_read_reg(client, LM90_REG_R_LOCAL_CRIT);
- if (val < 0)
- return val;
- data->temp8[LOCAL_CRIT] = val;
- val = lm90_read_reg(client, LM90_REG_R_REMOTE_CRIT);
- if (val < 0)
- return val;
- data->temp8[REMOTE_CRIT] = val;
- val = lm90_read_reg(client, LM90_REG_R_TCRIT_HYST);
- if (val < 0)
- return val;
- data->temp_hyst = val;
- val = lm90_read_reg(client, LM90_REG_R_REMOTE_LOWH);
- if (val < 0)
- return val;
- data->temp11[REMOTE_LOW] = val << 8;
- if (data->flags & LM90_HAVE_REM_LIMIT_EXT) {
- val = lm90_read_reg(client, LM90_REG_R_REMOTE_LOWL);
- if (val < 0)
- return val;
- data->temp11[REMOTE_LOW] |= val;
- }
- val = lm90_read_reg(client, LM90_REG_R_REMOTE_HIGHH);
- if (val < 0)
- return val;
- data->temp11[REMOTE_HIGH] = val << 8;
- if (data->flags & LM90_HAVE_REM_LIMIT_EXT) {
- val = lm90_read_reg(client, LM90_REG_R_REMOTE_HIGHL);
- if (val < 0)
- return val;
- data->temp11[REMOTE_HIGH] |= val;
- }
- if (data->flags & LM90_HAVE_OFFSET) {
- val = lm90_read16(client, LM90_REG_R_REMOTE_OFFSH,
- LM90_REG_R_REMOTE_OFFSL);
- if (val < 0)
- return val;
- data->temp11[REMOTE_OFFSET] = val;
- }
- if (data->flags & LM90_HAVE_EMERGENCY) {
- val = lm90_read_reg(client, MAX6659_REG_R_LOCAL_EMERG);
- if (val < 0)
- return val;
- data->temp8[LOCAL_EMERG] = val;
- val = lm90_read_reg(client, MAX6659_REG_R_REMOTE_EMERG);
- if (val < 0)
- return val;
- data->temp8[REMOTE_EMERG] = val;
- }
- if (data->kind == max6696) {
- val = lm90_select_remote_channel(client, data, 1);
- if (val < 0)
- return val;
- val = lm90_read_reg(client, LM90_REG_R_REMOTE_CRIT);
- if (val < 0)
- return val;
- data->temp8[REMOTE2_CRIT] = val;
- val = lm90_read_reg(client, MAX6659_REG_R_REMOTE_EMERG);
- if (val < 0)
- return val;
- data->temp8[REMOTE2_EMERG] = val;
- val = lm90_read_reg(client, LM90_REG_R_REMOTE_LOWH);
- if (val < 0)
- return val;
- data->temp11[REMOTE2_LOW] = val << 8;
- val = lm90_read_reg(client, LM90_REG_R_REMOTE_HIGHH);
- if (val < 0)
- return val;
- data->temp11[REMOTE2_HIGH] = val << 8;
- lm90_select_remote_channel(client, data, 0);
- }
- return 0;
- }
- static int lm90_update_device(struct device *dev)
- {
- struct lm90_data *data = dev_get_drvdata(dev);
- struct i2c_client *client = data->client;
- unsigned long next_update;
- int val;
- if (!data->valid) {
- val = lm90_update_limits(dev);
- if (val < 0)
- return val;
- }
- next_update = data->last_updated +
- msecs_to_jiffies(data->update_interval);
- if (time_after(jiffies, next_update) || !data->valid) {
- dev_dbg(&client->dev, "Updating lm90 data.\n");
- data->valid = false;
- val = lm90_read_reg(client, LM90_REG_R_LOCAL_LOW);
- if (val < 0)
- return val;
- data->temp8[LOCAL_LOW] = val;
- val = lm90_read_reg(client, LM90_REG_R_LOCAL_HIGH);
- if (val < 0)
- return val;
- data->temp8[LOCAL_HIGH] = val;
- if (data->reg_local_ext) {
- val = lm90_read16(client, LM90_REG_R_LOCAL_TEMP,
- data->reg_local_ext);
- if (val < 0)
- return val;
- data->temp11[LOCAL_TEMP] = val;
- } else {
- val = lm90_read_reg(client, LM90_REG_R_LOCAL_TEMP);
- if (val < 0)
- return val;
- data->temp11[LOCAL_TEMP] = val << 8;
- }
- val = lm90_read16(client, LM90_REG_R_REMOTE_TEMPH,
- LM90_REG_R_REMOTE_TEMPL);
- if (val < 0)
- return val;
- data->temp11[REMOTE_TEMP] = val;
- val = lm90_read_reg(client, LM90_REG_R_STATUS);
- if (val < 0)
- return val;
- data->alarms = val;
- if (data->kind == max6696) {
- val = lm90_select_remote_channel(client, data, 1);
- if (val < 0)
- return val;
- val = lm90_read16(client, LM90_REG_R_REMOTE_TEMPH,
- LM90_REG_R_REMOTE_TEMPL);
- if (val < 0) {
- lm90_select_remote_channel(client, data, 0);
- return val;
- }
- data->temp11[REMOTE2_TEMP] = val;
- lm90_select_remote_channel(client, data, 0);
- val = lm90_read_reg(client, MAX6696_REG_R_STATUS2);
- if (val < 0)
- return val;
- data->alarms |= val << 8;
- }
-
- if (!(data->config_orig & 0x80) &&
- !(data->alarms & data->alert_alarms)) {
- val = lm90_read_reg(client, LM90_REG_R_CONFIG1);
- if (val < 0)
- return val;
- if (val & 0x80) {
- dev_dbg(&client->dev, "Re-enabling ALERT#\n");
- i2c_smbus_write_byte_data(client,
- LM90_REG_W_CONFIG1,
- val & ~0x80);
- }
- }
- data->last_updated = jiffies;
- data->valid = true;
- }
- return 0;
- }
- static inline int temp_from_s8(s8 val)
- {
- return val * 1000;
- }
- static inline int temp_from_u8(u8 val)
- {
- return val * 1000;
- }
- static inline int temp_from_s16(s16 val)
- {
- return val / 32 * 125;
- }
- static inline int temp_from_u16(u16 val)
- {
- return val / 32 * 125;
- }
- static s8 temp_to_s8(long val)
- {
- if (val <= -128000)
- return -128;
- if (val >= 127000)
- return 127;
- if (val < 0)
- return (val - 500) / 1000;
- return (val + 500) / 1000;
- }
- static u8 temp_to_u8(long val)
- {
- if (val <= 0)
- return 0;
- if (val >= 255000)
- return 255;
- return (val + 500) / 1000;
- }
- static s16 temp_to_s16(long val)
- {
- if (val <= -128000)
- return 0x8000;
- if (val >= 127875)
- return 0x7FE0;
- if (val < 0)
- return (val - 62) / 125 * 32;
- return (val + 62) / 125 * 32;
- }
- static u8 hyst_to_reg(long val)
- {
- if (val <= 0)
- return 0;
- if (val >= 30500)
- return 31;
- return (val + 500) / 1000;
- }
- static inline int temp_from_u8_adt7461(struct lm90_data *data, u8 val)
- {
- if (data->flags & LM90_FLAG_ADT7461_EXT)
- return (val - 64) * 1000;
- return temp_from_s8(val);
- }
- static inline int temp_from_u16_adt7461(struct lm90_data *data, u16 val)
- {
- if (data->flags & LM90_FLAG_ADT7461_EXT)
- return (val - 0x4000) / 64 * 250;
- return temp_from_s16(val);
- }
- static u8 temp_to_u8_adt7461(struct lm90_data *data, long val)
- {
- if (data->flags & LM90_FLAG_ADT7461_EXT) {
- if (val <= -64000)
- return 0;
- if (val >= 191000)
- return 0xFF;
- return (val + 500 + 64000) / 1000;
- }
- if (val <= 0)
- return 0;
- if (val >= 127000)
- return 127;
- return (val + 500) / 1000;
- }
- static u16 temp_to_u16_adt7461(struct lm90_data *data, long val)
- {
- if (data->flags & LM90_FLAG_ADT7461_EXT) {
- if (val <= -64000)
- return 0;
- if (val >= 191750)
- return 0xFFC0;
- return (val + 64000 + 125) / 250 * 64;
- }
- if (val <= 0)
- return 0;
- if (val >= 127750)
- return 0x7FC0;
- return (val + 125) / 250 * 64;
- }
- static ssize_t show_pec(struct device *dev, struct device_attribute *dummy,
- char *buf)
- {
- struct i2c_client *client = to_i2c_client(dev);
- return sprintf(buf, "%d\n", !!(client->flags & I2C_CLIENT_PEC));
- }
- static ssize_t set_pec(struct device *dev, struct device_attribute *dummy,
- const char *buf, size_t count)
- {
- struct i2c_client *client = to_i2c_client(dev);
- long val;
- int err;
- err = kstrtol(buf, 10, &val);
- if (err < 0)
- return err;
- switch (val) {
- case 0:
- client->flags &= ~I2C_CLIENT_PEC;
- break;
- case 1:
- client->flags |= I2C_CLIENT_PEC;
- break;
- default:
- return -EINVAL;
- }
- return count;
- }
- static DEVICE_ATTR(pec, S_IWUSR | S_IRUGO, show_pec, set_pec);
- static int lm90_get_temp11(struct lm90_data *data, int index)
- {
- s16 temp11 = data->temp11[index];
- int temp;
- if (data->kind == adt7461 || data->kind == tmp451)
- temp = temp_from_u16_adt7461(data, temp11);
- else if (data->kind == max6646)
- temp = temp_from_u16(temp11);
- else
- temp = temp_from_s16(temp11);
-
- if (data->kind == lm99 && index <= 2)
- temp += 16000;
- return temp;
- }
- static int lm90_set_temp11(struct lm90_data *data, int index, long val)
- {
- static struct reg {
- u8 high;
- u8 low;
- } reg[] = {
- [REMOTE_LOW] = { LM90_REG_W_REMOTE_LOWH, LM90_REG_W_REMOTE_LOWL },
- [REMOTE_HIGH] = { LM90_REG_W_REMOTE_HIGHH, LM90_REG_W_REMOTE_HIGHL },
- [REMOTE_OFFSET] = { LM90_REG_W_REMOTE_OFFSH, LM90_REG_W_REMOTE_OFFSL },
- [REMOTE2_LOW] = { LM90_REG_W_REMOTE_LOWH, LM90_REG_W_REMOTE_LOWL },
- [REMOTE2_HIGH] = { LM90_REG_W_REMOTE_HIGHH, LM90_REG_W_REMOTE_HIGHL }
- };
- struct i2c_client *client = data->client;
- struct reg *regp = ®[index];
- int err;
-
- if (data->kind == lm99 && index <= 2)
- val -= 16000;
- if (data->kind == adt7461 || data->kind == tmp451)
- data->temp11[index] = temp_to_u16_adt7461(data, val);
- else if (data->kind == max6646)
- data->temp11[index] = temp_to_u8(val) << 8;
- else if (data->flags & LM90_HAVE_REM_LIMIT_EXT)
- data->temp11[index] = temp_to_s16(val);
- else
- data->temp11[index] = temp_to_s8(val) << 8;
- lm90_select_remote_channel(client, data, index >= 3);
- err = i2c_smbus_write_byte_data(client, regp->high,
- data->temp11[index] >> 8);
- if (err < 0)
- return err;
- if (data->flags & LM90_HAVE_REM_LIMIT_EXT)
- err = i2c_smbus_write_byte_data(client, regp->low,
- data->temp11[index] & 0xff);
- lm90_select_remote_channel(client, data, 0);
- return err;
- }
- static int lm90_get_temp8(struct lm90_data *data, int index)
- {
- s8 temp8 = data->temp8[index];
- int temp;
- if (data->kind == adt7461 || data->kind == tmp451)
- temp = temp_from_u8_adt7461(data, temp8);
- else if (data->kind == max6646)
- temp = temp_from_u8(temp8);
- else
- temp = temp_from_s8(temp8);
-
- if (data->kind == lm99 && index == 3)
- temp += 16000;
- return temp;
- }
- static int lm90_set_temp8(struct lm90_data *data, int index, long val)
- {
- static const u8 reg[TEMP8_REG_NUM] = {
- LM90_REG_W_LOCAL_LOW,
- LM90_REG_W_LOCAL_HIGH,
- LM90_REG_W_LOCAL_CRIT,
- LM90_REG_W_REMOTE_CRIT,
- MAX6659_REG_W_LOCAL_EMERG,
- MAX6659_REG_W_REMOTE_EMERG,
- LM90_REG_W_REMOTE_CRIT,
- MAX6659_REG_W_REMOTE_EMERG,
- };
- struct i2c_client *client = data->client;
- int err;
-
- if (data->kind == lm99 && index == 3)
- val -= 16000;
- if (data->kind == adt7461 || data->kind == tmp451)
- data->temp8[index] = temp_to_u8_adt7461(data, val);
- else if (data->kind == max6646)
- data->temp8[index] = temp_to_u8(val);
- else
- data->temp8[index] = temp_to_s8(val);
- lm90_select_remote_channel(client, data, index >= 6);
- err = i2c_smbus_write_byte_data(client, reg[index], data->temp8[index]);
- lm90_select_remote_channel(client, data, 0);
- return err;
- }
- static int lm90_get_temphyst(struct lm90_data *data, int index)
- {
- int temp;
- if (data->kind == adt7461 || data->kind == tmp451)
- temp = temp_from_u8_adt7461(data, data->temp8[index]);
- else if (data->kind == max6646)
- temp = temp_from_u8(data->temp8[index]);
- else
- temp = temp_from_s8(data->temp8[index]);
-
- if (data->kind == lm99 && index == 3)
- temp += 16000;
- return temp - temp_from_s8(data->temp_hyst);
- }
- static int lm90_set_temphyst(struct lm90_data *data, long val)
- {
- struct i2c_client *client = data->client;
- int temp;
- int err;
- if (data->kind == adt7461 || data->kind == tmp451)
- temp = temp_from_u8_adt7461(data, data->temp8[LOCAL_CRIT]);
- else if (data->kind == max6646)
- temp = temp_from_u8(data->temp8[LOCAL_CRIT]);
- else
- temp = temp_from_s8(data->temp8[LOCAL_CRIT]);
- data->temp_hyst = hyst_to_reg(temp - val);
- err = i2c_smbus_write_byte_data(client, LM90_REG_W_TCRIT_HYST,
- data->temp_hyst);
- return err;
- }
- static const u8 lm90_temp_index[3] = {
- LOCAL_TEMP, REMOTE_TEMP, REMOTE2_TEMP
- };
- static const u8 lm90_temp_min_index[3] = {
- LOCAL_LOW, REMOTE_LOW, REMOTE2_LOW
- };
- static const u8 lm90_temp_max_index[3] = {
- LOCAL_HIGH, REMOTE_HIGH, REMOTE2_HIGH
- };
- static const u8 lm90_temp_crit_index[3] = {
- LOCAL_CRIT, REMOTE_CRIT, REMOTE2_CRIT
- };
- static const u8 lm90_temp_emerg_index[3] = {
- LOCAL_EMERG, REMOTE_EMERG, REMOTE2_EMERG
- };
- static const u8 lm90_min_alarm_bits[3] = { 5, 3, 11 };
- static const u8 lm90_max_alarm_bits[3] = { 6, 4, 12 };
- static const u8 lm90_crit_alarm_bits[3] = { 0, 1, 9 };
- static const u8 lm90_emergency_alarm_bits[3] = { 15, 13, 14 };
- static const u8 lm90_fault_bits[3] = { 0, 2, 10 };
- static int lm90_temp_read(struct device *dev, u32 attr, int channel, long *val)
- {
- struct lm90_data *data = dev_get_drvdata(dev);
- int err;
- mutex_lock(&data->update_lock);
- err = lm90_update_device(dev);
- mutex_unlock(&data->update_lock);
- if (err)
- return err;
- switch (attr) {
- case hwmon_temp_input:
- *val = lm90_get_temp11(data, lm90_temp_index[channel]);
- break;
- case hwmon_temp_min_alarm:
- *val = (data->alarms >> lm90_min_alarm_bits[channel]) & 1;
- break;
- case hwmon_temp_max_alarm:
- *val = (data->alarms >> lm90_max_alarm_bits[channel]) & 1;
- break;
- case hwmon_temp_crit_alarm:
- *val = (data->alarms >> lm90_crit_alarm_bits[channel]) & 1;
- break;
- case hwmon_temp_emergency_alarm:
- *val = (data->alarms >> lm90_emergency_alarm_bits[channel]) & 1;
- break;
- case hwmon_temp_fault:
- *val = (data->alarms >> lm90_fault_bits[channel]) & 1;
- break;
- case hwmon_temp_min:
- if (channel == 0)
- *val = lm90_get_temp8(data,
- lm90_temp_min_index[channel]);
- else
- *val = lm90_get_temp11(data,
- lm90_temp_min_index[channel]);
- break;
- case hwmon_temp_max:
- if (channel == 0)
- *val = lm90_get_temp8(data,
- lm90_temp_max_index[channel]);
- else
- *val = lm90_get_temp11(data,
- lm90_temp_max_index[channel]);
- break;
- case hwmon_temp_crit:
- *val = lm90_get_temp8(data, lm90_temp_crit_index[channel]);
- break;
- case hwmon_temp_crit_hyst:
- *val = lm90_get_temphyst(data, lm90_temp_crit_index[channel]);
- break;
- case hwmon_temp_emergency:
- *val = lm90_get_temp8(data, lm90_temp_emerg_index[channel]);
- break;
- case hwmon_temp_emergency_hyst:
- *val = lm90_get_temphyst(data, lm90_temp_emerg_index[channel]);
- break;
- case hwmon_temp_offset:
- *val = lm90_get_temp11(data, REMOTE_OFFSET);
- break;
- default:
- return -EOPNOTSUPP;
- }
- return 0;
- }
- static int lm90_temp_write(struct device *dev, u32 attr, int channel, long val)
- {
- struct lm90_data *data = dev_get_drvdata(dev);
- int err;
- mutex_lock(&data->update_lock);
- err = lm90_update_device(dev);
- if (err)
- goto error;
- switch (attr) {
- case hwmon_temp_min:
- if (channel == 0)
- err = lm90_set_temp8(data,
- lm90_temp_min_index[channel],
- val);
- else
- err = lm90_set_temp11(data,
- lm90_temp_min_index[channel],
- val);
- break;
- case hwmon_temp_max:
- if (channel == 0)
- err = lm90_set_temp8(data,
- lm90_temp_max_index[channel],
- val);
- else
- err = lm90_set_temp11(data,
- lm90_temp_max_index[channel],
- val);
- break;
- case hwmon_temp_crit:
- err = lm90_set_temp8(data, lm90_temp_crit_index[channel], val);
- break;
- case hwmon_temp_crit_hyst:
- err = lm90_set_temphyst(data, val);
- break;
- case hwmon_temp_emergency:
- err = lm90_set_temp8(data, lm90_temp_emerg_index[channel], val);
- break;
- case hwmon_temp_offset:
- err = lm90_set_temp11(data, REMOTE_OFFSET, val);
- break;
- default:
- err = -EOPNOTSUPP;
- break;
- }
- error:
- mutex_unlock(&data->update_lock);
- return err;
- }
- static umode_t lm90_temp_is_visible(const void *data, u32 attr, int channel)
- {
- switch (attr) {
- case hwmon_temp_input:
- case hwmon_temp_min_alarm:
- case hwmon_temp_max_alarm:
- case hwmon_temp_crit_alarm:
- case hwmon_temp_emergency_alarm:
- case hwmon_temp_emergency_hyst:
- case hwmon_temp_fault:
- return S_IRUGO;
- case hwmon_temp_min:
- case hwmon_temp_max:
- case hwmon_temp_crit:
- case hwmon_temp_emergency:
- case hwmon_temp_offset:
- return S_IRUGO | S_IWUSR;
- case hwmon_temp_crit_hyst:
- if (channel == 0)
- return S_IRUGO | S_IWUSR;
- return S_IRUGO;
- default:
- return 0;
- }
- }
- static int lm90_chip_read(struct device *dev, u32 attr, int channel, long *val)
- {
- struct lm90_data *data = dev_get_drvdata(dev);
- int err;
- mutex_lock(&data->update_lock);
- err = lm90_update_device(dev);
- mutex_unlock(&data->update_lock);
- if (err)
- return err;
- switch (attr) {
- case hwmon_chip_update_interval:
- *val = data->update_interval;
- break;
- case hwmon_chip_alarms:
- *val = data->alarms;
- break;
- default:
- return -EOPNOTSUPP;
- }
- return 0;
- }
- static int lm90_chip_write(struct device *dev, u32 attr, int channel, long val)
- {
- struct lm90_data *data = dev_get_drvdata(dev);
- struct i2c_client *client = data->client;
- int err;
- mutex_lock(&data->update_lock);
- err = lm90_update_device(dev);
- if (err)
- goto error;
- switch (attr) {
- case hwmon_chip_update_interval:
- err = lm90_set_convrate(client, data,
- clamp_val(val, 0, 100000));
- break;
- default:
- err = -EOPNOTSUPP;
- break;
- }
- error:
- mutex_unlock(&data->update_lock);
- return err;
- }
- static umode_t lm90_chip_is_visible(const void *data, u32 attr, int channel)
- {
- switch (attr) {
- case hwmon_chip_update_interval:
- return S_IRUGO | S_IWUSR;
- case hwmon_chip_alarms:
- return S_IRUGO;
- default:
- return 0;
- }
- }
- static int lm90_read(struct device *dev, enum hwmon_sensor_types type,
- u32 attr, int channel, long *val)
- {
- switch (type) {
- case hwmon_chip:
- return lm90_chip_read(dev, attr, channel, val);
- case hwmon_temp:
- return lm90_temp_read(dev, attr, channel, val);
- default:
- return -EOPNOTSUPP;
- }
- }
- static int lm90_write(struct device *dev, enum hwmon_sensor_types type,
- u32 attr, int channel, long val)
- {
- switch (type) {
- case hwmon_chip:
- return lm90_chip_write(dev, attr, channel, val);
- case hwmon_temp:
- return lm90_temp_write(dev, attr, channel, val);
- default:
- return -EOPNOTSUPP;
- }
- }
- static umode_t lm90_is_visible(const void *data, enum hwmon_sensor_types type,
- u32 attr, int channel)
- {
- switch (type) {
- case hwmon_chip:
- return lm90_chip_is_visible(data, attr, channel);
- case hwmon_temp:
- return lm90_temp_is_visible(data, attr, channel);
- default:
- return 0;
- }
- }
- static int lm90_detect(struct i2c_client *client,
- struct i2c_board_info *info)
- {
- struct i2c_adapter *adapter = client->adapter;
- int address = client->addr;
- const char *name = NULL;
- int man_id, chip_id, config1, config2, convrate;
- if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
- return -ENODEV;
-
- man_id = i2c_smbus_read_byte_data(client, LM90_REG_R_MAN_ID);
- chip_id = i2c_smbus_read_byte_data(client, LM90_REG_R_CHIP_ID);
- config1 = i2c_smbus_read_byte_data(client, LM90_REG_R_CONFIG1);
- convrate = i2c_smbus_read_byte_data(client, LM90_REG_R_CONVRATE);
- if (man_id < 0 || chip_id < 0 || config1 < 0 || convrate < 0)
- return -ENODEV;
- if (man_id == 0x01 || man_id == 0x5C || man_id == 0x41) {
- config2 = i2c_smbus_read_byte_data(client, LM90_REG_R_CONFIG2);
- if (config2 < 0)
- return -ENODEV;
- } else
- config2 = 0;
- if ((address == 0x4C || address == 0x4D)
- && man_id == 0x01) {
- if ((config1 & 0x2A) == 0x00
- && (config2 & 0xF8) == 0x00
- && convrate <= 0x09) {
- if (address == 0x4C
- && (chip_id & 0xF0) == 0x20) {
- name = "lm90";
- } else
- if ((chip_id & 0xF0) == 0x30) {
- name = "lm99";
- dev_info(&adapter->dev,
- "Assuming LM99 chip at 0x%02x\n",
- address);
- dev_info(&adapter->dev,
- "If it is an LM89, instantiate it "
- "with the new_device sysfs "
- "interface\n");
- } else
- if (address == 0x4C
- && (chip_id & 0xF0) == 0x10) {
- name = "lm86";
- }
- }
- } else
- if ((address == 0x4C || address == 0x4D)
- && man_id == 0x41) {
- if ((chip_id & 0xF0) == 0x40
- && (config1 & 0x3F) == 0x00
- && convrate <= 0x0A) {
- name = "adm1032";
-
- if (i2c_check_functionality(adapter,
- I2C_FUNC_SMBUS_BYTE))
- info->flags |= I2C_CLIENT_PEC;
- } else
- if (chip_id == 0x51
- && (config1 & 0x1B) == 0x00
- && convrate <= 0x0A) {
- name = "adt7461";
- } else
- if (chip_id == 0x57
- && (config1 & 0x1B) == 0x00
- && convrate <= 0x0A) {
- name = "adt7461a";
- }
- } else
- if (man_id == 0x4D) {
- int emerg, emerg2, status2;
-
- emerg = i2c_smbus_read_byte_data(client,
- MAX6659_REG_R_REMOTE_EMERG);
- man_id = i2c_smbus_read_byte_data(client,
- LM90_REG_R_MAN_ID);
- emerg2 = i2c_smbus_read_byte_data(client,
- MAX6659_REG_R_REMOTE_EMERG);
- status2 = i2c_smbus_read_byte_data(client,
- MAX6696_REG_R_STATUS2);
- if (emerg < 0 || man_id < 0 || emerg2 < 0 || status2 < 0)
- return -ENODEV;
-
- if (chip_id == man_id
- && (address == 0x4C || address == 0x4D || address == 0x4E)
- && (config1 & 0x1F) == (man_id & 0x0F)
- && convrate <= 0x09) {
- if (address == 0x4C)
- name = "max6657";
- else
- name = "max6659";
- } else
-
- if (chip_id == 0x01
- && (config1 & 0x10) == 0x00
- && (status2 & 0x01) == 0x00
- && emerg == emerg2
- && convrate <= 0x07) {
- name = "max6696";
- } else
-
- if (chip_id == 0x01
- && (config1 & 0x03) == 0x00
- && convrate <= 0x07) {
- name = "max6680";
- } else
-
- if (chip_id == 0x59
- && (config1 & 0x3f) == 0x00
- && convrate <= 0x07) {
- name = "max6646";
- }
- } else
- if (address == 0x4C
- && man_id == 0x5C) {
- if ((config1 & 0x2A) == 0x00
- && (config2 & 0xF8) == 0x00) {
- if (chip_id == 0x01
- && convrate <= 0x09) {
- name = "w83l771";
- } else
- if ((chip_id & 0xFE) == 0x10
- && convrate <= 0x08) {
- name = "w83l771";
- }
- }
- } else
- if (address >= 0x48 && address <= 0x4F
- && man_id == 0xA1) {
- if (chip_id == 0x00
- && (config1 & 0x2A) == 0x00
- && (config2 & 0xFE) == 0x00
- && convrate <= 0x09) {
- name = "sa56004";
- }
- } else
- if ((address == 0x4C || address == 0x4D)
- && man_id == 0x47) {
- if (chip_id == 0x01
- && (config1 & 0x3F) == 0x00
- && convrate <= 0x08)
- name = "g781";
- } else
- if (address == 0x4C
- && man_id == 0x55) {
- int local_ext;
- local_ext = i2c_smbus_read_byte_data(client,
- TMP451_REG_R_LOCAL_TEMPL);
- if (chip_id == 0x00
- && (config1 & 0x1B) == 0x00
- && convrate <= 0x09
- && (local_ext & 0x0F) == 0x00)
- name = "tmp451";
- }
- if (!name) {
- dev_dbg(&adapter->dev,
- "Unsupported chip at 0x%02x (man_id=0x%02X, "
- "chip_id=0x%02X)\n", address, man_id, chip_id);
- return -ENODEV;
- }
- strlcpy(info->type, name, I2C_NAME_SIZE);
- return 0;
- }
- static void lm90_restore_conf(void *_data)
- {
- struct lm90_data *data = _data;
- struct i2c_client *client = data->client;
-
- i2c_smbus_write_byte_data(client, LM90_REG_W_CONVRATE,
- data->convrate_orig);
- i2c_smbus_write_byte_data(client, LM90_REG_W_CONFIG1,
- data->config_orig);
- }
- static int lm90_init_client(struct i2c_client *client, struct lm90_data *data)
- {
- int config, convrate;
- convrate = lm90_read_reg(client, LM90_REG_R_CONVRATE);
- if (convrate < 0)
- return convrate;
- data->convrate_orig = convrate;
-
- lm90_set_convrate(client, data, 500);
- config = lm90_read_reg(client, LM90_REG_R_CONFIG1);
- if (config < 0)
- return config;
- data->config_orig = config;
-
- if (data->kind == adt7461 || data->kind == tmp451) {
- if (config & 0x04)
- data->flags |= LM90_FLAG_ADT7461_EXT;
- }
-
- if (data->kind == max6680)
- config |= 0x18;
-
- if (data->kind == max6696)
- config &= ~0x08;
- config &= 0xBF;
- if (config != data->config_orig)
- i2c_smbus_write_byte_data(client, LM90_REG_W_CONFIG1, config);
- return devm_add_action_or_reset(&client->dev, lm90_restore_conf, data);
- }
- static bool lm90_is_tripped(struct i2c_client *client, u16 *status)
- {
- struct lm90_data *data = i2c_get_clientdata(client);
- int st, st2 = 0;
- st = lm90_read_reg(client, LM90_REG_R_STATUS);
- if (st < 0)
- return false;
- if (data->kind == max6696) {
- st2 = lm90_read_reg(client, MAX6696_REG_R_STATUS2);
- if (st2 < 0)
- return false;
- }
- *status = st | (st2 << 8);
- if ((st & 0x7f) == 0 && (st2 & 0xfe) == 0)
- return false;
- if ((st & (LM90_STATUS_LLOW | LM90_STATUS_LHIGH | LM90_STATUS_LTHRM)) ||
- (st2 & MAX6696_STATUS2_LOT2))
- dev_warn(&client->dev,
- "temp%d out of range, please check!\n", 1);
- if ((st & (LM90_STATUS_RLOW | LM90_STATUS_RHIGH | LM90_STATUS_RTHRM)) ||
- (st2 & MAX6696_STATUS2_ROT2))
- dev_warn(&client->dev,
- "temp%d out of range, please check!\n", 2);
- if (st & LM90_STATUS_ROPEN)
- dev_warn(&client->dev,
- "temp%d diode open, please check!\n", 2);
- if (st2 & (MAX6696_STATUS2_R2LOW | MAX6696_STATUS2_R2HIGH |
- MAX6696_STATUS2_R2THRM | MAX6696_STATUS2_R2OT2))
- dev_warn(&client->dev,
- "temp%d out of range, please check!\n", 3);
- if (st2 & MAX6696_STATUS2_R2OPEN)
- dev_warn(&client->dev,
- "temp%d diode open, please check!\n", 3);
- return true;
- }
- static irqreturn_t lm90_irq_thread(int irq, void *dev_id)
- {
- struct i2c_client *client = dev_id;
- u16 status;
- if (lm90_is_tripped(client, &status))
- return IRQ_HANDLED;
- else
- return IRQ_NONE;
- }
- static void lm90_remove_pec(void *dev)
- {
- device_remove_file(dev, &dev_attr_pec);
- }
- static void lm90_regulator_disable(void *regulator)
- {
- regulator_disable(regulator);
- }
- static const u32 lm90_chip_config[] = {
- HWMON_C_REGISTER_TZ | HWMON_C_UPDATE_INTERVAL | HWMON_C_ALARMS,
- 0
- };
- static const struct hwmon_channel_info lm90_chip_info = {
- .type = hwmon_chip,
- .config = lm90_chip_config,
- };
- static const struct hwmon_ops lm90_ops = {
- .is_visible = lm90_is_visible,
- .read = lm90_read,
- .write = lm90_write,
- };
- static int lm90_probe(struct i2c_client *client,
- const struct i2c_device_id *id)
- {
- struct device *dev = &client->dev;
- struct i2c_adapter *adapter = to_i2c_adapter(dev->parent);
- struct hwmon_channel_info *info;
- struct regulator *regulator;
- struct device *hwmon_dev;
- struct lm90_data *data;
- int err;
- regulator = devm_regulator_get(dev, "vcc");
- if (IS_ERR(regulator))
- return PTR_ERR(regulator);
- err = regulator_enable(regulator);
- if (err < 0) {
- dev_err(dev, "Failed to enable regulator: %d\n", err);
- return err;
- }
- err = devm_add_action_or_reset(dev, lm90_regulator_disable, regulator);
- if (err)
- return err;
- data = devm_kzalloc(dev, sizeof(struct lm90_data), GFP_KERNEL);
- if (!data)
- return -ENOMEM;
- data->client = client;
- i2c_set_clientdata(client, data);
- mutex_init(&data->update_lock);
-
- data->kind = id->driver_data;
- if (data->kind == adm1032) {
- if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE))
- client->flags &= ~I2C_CLIENT_PEC;
- }
-
- data->alert_alarms = lm90_params[data->kind].alert_alarms;
-
- data->flags = lm90_params[data->kind].flags;
- data->chip.ops = &lm90_ops;
- data->chip.info = data->info;
- data->info[0] = &lm90_chip_info;
- data->info[1] = &data->temp_info;
- info = &data->temp_info;
- info->type = hwmon_temp;
- info->config = data->channel_config;
- data->channel_config[0] = HWMON_T_INPUT | HWMON_T_MIN | HWMON_T_MAX |
- HWMON_T_CRIT | HWMON_T_CRIT_HYST | HWMON_T_MIN_ALARM |
- HWMON_T_MAX_ALARM | HWMON_T_CRIT_ALARM;
- data->channel_config[1] = HWMON_T_INPUT | HWMON_T_MIN | HWMON_T_MAX |
- HWMON_T_CRIT | HWMON_T_CRIT_HYST | HWMON_T_MIN_ALARM |
- HWMON_T_MAX_ALARM | HWMON_T_CRIT_ALARM | HWMON_T_FAULT;
- if (data->flags & LM90_HAVE_OFFSET)
- data->channel_config[1] |= HWMON_T_OFFSET;
- if (data->flags & LM90_HAVE_EMERGENCY) {
- data->channel_config[0] |= HWMON_T_EMERGENCY |
- HWMON_T_EMERGENCY_HYST;
- data->channel_config[1] |= HWMON_T_EMERGENCY |
- HWMON_T_EMERGENCY_HYST;
- }
- if (data->flags & LM90_HAVE_EMERGENCY_ALARM) {
- data->channel_config[0] |= HWMON_T_EMERGENCY_ALARM;
- data->channel_config[1] |= HWMON_T_EMERGENCY_ALARM;
- }
- if (data->flags & LM90_HAVE_TEMP3) {
- data->channel_config[2] = HWMON_T_INPUT |
- HWMON_T_MIN | HWMON_T_MAX |
- HWMON_T_CRIT | HWMON_T_CRIT_HYST |
- HWMON_T_EMERGENCY | HWMON_T_EMERGENCY_HYST |
- HWMON_T_MIN_ALARM | HWMON_T_MAX_ALARM |
- HWMON_T_CRIT_ALARM | HWMON_T_EMERGENCY_ALARM |
- HWMON_T_FAULT;
- }
- data->reg_local_ext = lm90_params[data->kind].reg_local_ext;
-
- data->max_convrate = lm90_params[data->kind].max_convrate;
-
- err = lm90_init_client(client, data);
- if (err < 0) {
- dev_err(dev, "Failed to initialize device\n");
- return err;
- }
-
- if (client->flags & I2C_CLIENT_PEC) {
- err = device_create_file(dev, &dev_attr_pec);
- if (err)
- return err;
- err = devm_add_action_or_reset(dev, lm90_remove_pec, dev);
- if (err)
- return err;
- }
- hwmon_dev = devm_hwmon_device_register_with_info(dev, client->name,
- data, &data->chip,
- NULL);
- if (IS_ERR(hwmon_dev))
- return PTR_ERR(hwmon_dev);
- if (client->irq) {
- dev_dbg(dev, "IRQ: %d\n", client->irq);
- err = devm_request_threaded_irq(dev, client->irq,
- NULL, lm90_irq_thread,
- IRQF_TRIGGER_LOW | IRQF_ONESHOT,
- "lm90", client);
- if (err < 0) {
- dev_err(dev, "cannot request IRQ %d\n", client->irq);
- return err;
- }
- }
- return 0;
- }
- static void lm90_alert(struct i2c_client *client, enum i2c_alert_protocol type,
- unsigned int flag)
- {
- u16 alarms;
- if (type != I2C_PROTOCOL_SMBUS_ALERT)
- return;
- if (lm90_is_tripped(client, &alarms)) {
-
- struct lm90_data *data = i2c_get_clientdata(client);
- if ((data->flags & LM90_HAVE_BROKEN_ALERT) &&
- (alarms & data->alert_alarms)) {
- int config;
- dev_dbg(&client->dev, "Disabling ALERT#\n");
- config = lm90_read_reg(client, LM90_REG_R_CONFIG1);
- if (config >= 0)
- i2c_smbus_write_byte_data(client,
- LM90_REG_W_CONFIG1,
- config | 0x80);
- }
- } else {
- dev_info(&client->dev, "Everything OK\n");
- }
- }
- static struct i2c_driver lm90_driver = {
- .class = I2C_CLASS_HWMON,
- .driver = {
- .name = "lm90",
- },
- .probe = lm90_probe,
- .alert = lm90_alert,
- .id_table = lm90_id,
- .detect = lm90_detect,
- .address_list = normal_i2c,
- };
- module_i2c_driver(lm90_driver);
- MODULE_AUTHOR("Jean Delvare <jdelvare@suse.de>");
- MODULE_DESCRIPTION("LM90/ADM1032 driver");
- MODULE_LICENSE("GPL");
|