1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750 |
- /***************************************************************************
- * Copyright (C) 2006 by Hans Edgington <hans@edgington.nl> *
- * Copyright (C) 2007,2008 by Hans de Goede <hdegoede@redhat.com> *
- * *
- * This program is free software; you can redistribute it and/or modify *
- * it under the terms of the GNU General Public License as published by *
- * the Free Software Foundation; either version 2 of the License, or *
- * (at your option) any later version. *
- * *
- * This program is distributed in the hope that it will be useful, *
- * but WITHOUT ANY WARRANTY; without even the implied warranty of *
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
- * GNU General Public License for more details. *
- * *
- * You should have received a copy of the GNU General Public License *
- * along with this program; if not, write to the *
- * Free Software Foundation, Inc., *
- * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
- ***************************************************************************/
- #include <linux/module.h>
- #include <linux/init.h>
- #include <linux/slab.h>
- #include <linux/jiffies.h>
- #include <linux/platform_device.h>
- #include <linux/hwmon.h>
- #include <linux/hwmon-sysfs.h>
- #include <linux/err.h>
- #include <linux/mutex.h>
- #include <linux/io.h>
- #define DRVNAME "f71882fg"
- #define SIO_F71882FG_LD_HWM 0x04 /* Hardware monitor logical device */
- #define SIO_UNLOCK_KEY 0x87 /* Key to enable Super-I/O */
- #define SIO_LOCK_KEY 0xAA /* Key to diasble Super-I/O */
- #define SIO_REG_LDSEL 0x07 /* Logical device select */
- #define SIO_REG_DEVID 0x20 /* Device ID (2 bytes) */
- #define SIO_REG_DEVREV 0x22 /* Device revision */
- #define SIO_REG_MANID 0x23 /* Fintek ID (2 bytes) */
- #define SIO_REG_ENABLE 0x30 /* Logical device enable */
- #define SIO_REG_ADDR 0x60 /* Logical device address (2 bytes) */
- #define SIO_FINTEK_ID 0x1934 /* Manufacturers ID */
- #define SIO_F71862_ID 0x0601 /* Chipset ID */
- #define SIO_F71882_ID 0x0541 /* Chipset ID */
- #define REGION_LENGTH 8
- #define ADDR_REG_OFFSET 5
- #define DATA_REG_OFFSET 6
- #define F71882FG_REG_PECI 0x0A
- #define F71882FG_REG_IN_STATUS 0x12 /* f71882fg only */
- #define F71882FG_REG_IN_BEEP 0x13 /* f71882fg only */
- #define F71882FG_REG_IN(nr) (0x20 + (nr))
- #define F71882FG_REG_IN1_HIGH 0x32 /* f71882fg only */
- #define F71882FG_REG_FAN(nr) (0xA0 + (16 * (nr)))
- #define F71882FG_REG_FAN_TARGET(nr) (0xA2 + (16 * (nr)))
- #define F71882FG_REG_FAN_FULL_SPEED(nr) (0xA4 + (16 * (nr)))
- #define F71882FG_REG_FAN_STATUS 0x92
- #define F71882FG_REG_FAN_BEEP 0x93
- #define F71882FG_REG_TEMP(nr) (0x72 + 2 * (nr))
- #define F71882FG_REG_TEMP_OVT(nr) (0x82 + 2 * (nr))
- #define F71882FG_REG_TEMP_HIGH(nr) (0x83 + 2 * (nr))
- #define F71882FG_REG_TEMP_STATUS 0x62
- #define F71882FG_REG_TEMP_BEEP 0x63
- #define F71882FG_REG_TEMP_HYST1 0x6C
- #define F71882FG_REG_TEMP_HYST23 0x6D
- #define F71882FG_REG_TEMP_TYPE 0x6B
- #define F71882FG_REG_TEMP_DIODE_OPEN 0x6F
- #define F71882FG_REG_PWM(nr) (0xA3 + (16 * (nr)))
- #define F71882FG_REG_PWM_TYPE 0x94
- #define F71882FG_REG_PWM_ENABLE 0x96
- #define F71882FG_REG_FAN_HYST0 0x98
- #define F71882FG_REG_FAN_HYST1 0x99
- #define F71882FG_REG_POINT_PWM(pwm, point) (0xAA + (point) + (16 * (pwm)))
- #define F71882FG_REG_POINT_TEMP(pwm, point) (0xA6 + (point) + (16 * (pwm)))
- #define F71882FG_REG_POINT_MAPPING(nr) (0xAF + 16 * (nr))
- #define F71882FG_REG_START 0x01
- #define FAN_MIN_DETECT 366 /* Lowest detectable fanspeed */
- static unsigned short force_id;
- module_param(force_id, ushort, 0);
- MODULE_PARM_DESC(force_id, "Override the detected device ID");
- static int fan_mode[4] = { 0, 0, 0, 0 };
- module_param_array(fan_mode, int, NULL, 0644);
- MODULE_PARM_DESC(fan_mode, "List of fan control modes (f71882fg only) "
- "(0=don't change, 1=pwm, 2=rpm)\n"
- "Note: this needs a write to pwm#_enable to take effect");
- enum chips { f71862fg, f71882fg };
- static const char *f71882fg_names[] = {
- "f71862fg",
- "f71882fg",
- };
- static struct platform_device *f71882fg_pdev;
- /* Super-I/O Function prototypes */
- static inline int superio_inb(int base, int reg);
- static inline int superio_inw(int base, int reg);
- static inline void superio_enter(int base);
- static inline void superio_select(int base, int ld);
- static inline void superio_exit(int base);
- struct f71882fg_sio_data {
- enum chips type;
- };
- struct f71882fg_data {
- unsigned short addr;
- enum chips type;
- struct device *hwmon_dev;
- struct mutex update_lock;
- char valid; /* !=0 if following fields are valid */
- unsigned long last_updated; /* In jiffies */
- unsigned long last_limits; /* In jiffies */
- /* Register Values */
- u8 in[9];
- u8 in1_max;
- u8 in_status;
- u8 in_beep;
- u16 fan[4];
- u16 fan_target[4];
- u16 fan_full_speed[4];
- u8 fan_status;
- u8 fan_beep;
- u8 temp[3];
- u8 temp_ovt[3];
- u8 temp_high[3];
- u8 temp_hyst[3];
- u8 temp_type[3];
- u8 temp_status;
- u8 temp_beep;
- u8 temp_diode_open;
- u8 pwm[4];
- u8 pwm_enable;
- u8 pwm_auto_point_hyst[2];
- u8 pwm_auto_point_mapping[4];
- u8 pwm_auto_point_pwm[4][5];
- u8 pwm_auto_point_temp[4][4];
- };
- /* Sysfs in */
- static ssize_t show_in(struct device *dev, struct device_attribute *devattr,
- char *buf);
- static ssize_t show_in_max(struct device *dev, struct device_attribute
- *devattr, char *buf);
- static ssize_t store_in_max(struct device *dev, struct device_attribute
- *devattr, const char *buf, size_t count);
- static ssize_t show_in_beep(struct device *dev, struct device_attribute
- *devattr, char *buf);
- static ssize_t store_in_beep(struct device *dev, struct device_attribute
- *devattr, const char *buf, size_t count);
- static ssize_t show_in_alarm(struct device *dev, struct device_attribute
- *devattr, char *buf);
- /* Sysfs Fan */
- static ssize_t show_fan(struct device *dev, struct device_attribute *devattr,
- char *buf);
- static ssize_t show_fan_full_speed(struct device *dev,
- struct device_attribute *devattr, char *buf);
- static ssize_t store_fan_full_speed(struct device *dev,
- struct device_attribute *devattr, const char *buf, size_t count);
- static ssize_t show_fan_beep(struct device *dev, struct device_attribute
- *devattr, char *buf);
- static ssize_t store_fan_beep(struct device *dev, struct device_attribute
- *devattr, const char *buf, size_t count);
- static ssize_t show_fan_alarm(struct device *dev, struct device_attribute
- *devattr, char *buf);
- /* Sysfs Temp */
- static ssize_t show_temp(struct device *dev, struct device_attribute
- *devattr, char *buf);
- static ssize_t show_temp_max(struct device *dev, struct device_attribute
- *devattr, char *buf);
- static ssize_t store_temp_max(struct device *dev, struct device_attribute
- *devattr, const char *buf, size_t count);
- static ssize_t show_temp_max_hyst(struct device *dev, struct device_attribute
- *devattr, char *buf);
- static ssize_t store_temp_max_hyst(struct device *dev, struct device_attribute
- *devattr, const char *buf, size_t count);
- static ssize_t show_temp_crit(struct device *dev, struct device_attribute
- *devattr, char *buf);
- static ssize_t store_temp_crit(struct device *dev, struct device_attribute
- *devattr, const char *buf, size_t count);
- static ssize_t show_temp_crit_hyst(struct device *dev, struct device_attribute
- *devattr, char *buf);
- static ssize_t show_temp_type(struct device *dev, struct device_attribute
- *devattr, char *buf);
- static ssize_t show_temp_beep(struct device *dev, struct device_attribute
- *devattr, char *buf);
- static ssize_t store_temp_beep(struct device *dev, struct device_attribute
- *devattr, const char *buf, size_t count);
- static ssize_t show_temp_alarm(struct device *dev, struct device_attribute
- *devattr, char *buf);
- static ssize_t show_temp_fault(struct device *dev, struct device_attribute
- *devattr, char *buf);
- /* PWM and Auto point control */
- static ssize_t show_pwm(struct device *dev, struct device_attribute *devattr,
- char *buf);
- static ssize_t store_pwm(struct device *dev, struct device_attribute *devattr,
- const char *buf, size_t count);
- static ssize_t show_pwm_enable(struct device *dev,
- struct device_attribute *devattr, char *buf);
- static ssize_t store_pwm_enable(struct device *dev,
- struct device_attribute *devattr, const char *buf, size_t count);
- static ssize_t show_pwm_interpolate(struct device *dev,
- struct device_attribute *devattr, char *buf);
- static ssize_t store_pwm_interpolate(struct device *dev,
- struct device_attribute *devattr, const char *buf, size_t count);
- static ssize_t show_pwm_auto_point_channel(struct device *dev,
- struct device_attribute *devattr, char *buf);
- static ssize_t store_pwm_auto_point_channel(struct device *dev,
- struct device_attribute *devattr, const char *buf, size_t count);
- static ssize_t show_pwm_auto_point_temp_hyst(struct device *dev,
- struct device_attribute *devattr, char *buf);
- static ssize_t store_pwm_auto_point_temp_hyst(struct device *dev,
- struct device_attribute *devattr, const char *buf, size_t count);
- static ssize_t show_pwm_auto_point_pwm(struct device *dev,
- struct device_attribute *devattr, char *buf);
- static ssize_t store_pwm_auto_point_pwm(struct device *dev,
- struct device_attribute *devattr, const char *buf, size_t count);
- static ssize_t show_pwm_auto_point_temp(struct device *dev,
- struct device_attribute *devattr, char *buf);
- static ssize_t store_pwm_auto_point_temp(struct device *dev,
- struct device_attribute *devattr, const char *buf, size_t count);
- /* Sysfs misc */
- static ssize_t show_name(struct device *dev, struct device_attribute *devattr,
- char *buf);
- static int __devinit f71882fg_probe(struct platform_device * pdev);
- static int f71882fg_remove(struct platform_device *pdev);
- static struct platform_driver f71882fg_driver = {
- .driver = {
- .owner = THIS_MODULE,
- .name = DRVNAME,
- },
- .probe = f71882fg_probe,
- .remove = __devexit_p(f71882fg_remove),
- };
- static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
- static struct sensor_device_attribute_2 f718x2fg_in_temp_attr[] = {
- SENSOR_ATTR_2(in0_input, S_IRUGO, show_in, NULL, 0, 0),
- SENSOR_ATTR_2(in1_input, S_IRUGO, show_in, NULL, 0, 1),
- SENSOR_ATTR_2(in2_input, S_IRUGO, show_in, NULL, 0, 2),
- SENSOR_ATTR_2(in3_input, S_IRUGO, show_in, NULL, 0, 3),
- SENSOR_ATTR_2(in4_input, S_IRUGO, show_in, NULL, 0, 4),
- SENSOR_ATTR_2(in5_input, S_IRUGO, show_in, NULL, 0, 5),
- SENSOR_ATTR_2(in6_input, S_IRUGO, show_in, NULL, 0, 6),
- SENSOR_ATTR_2(in7_input, S_IRUGO, show_in, NULL, 0, 7),
- SENSOR_ATTR_2(in8_input, S_IRUGO, show_in, NULL, 0, 8),
- SENSOR_ATTR_2(temp1_input, S_IRUGO, show_temp, NULL, 0, 0),
- SENSOR_ATTR_2(temp1_max, S_IRUGO|S_IWUSR, show_temp_max,
- store_temp_max, 0, 0),
- SENSOR_ATTR_2(temp1_max_hyst, S_IRUGO|S_IWUSR, show_temp_max_hyst,
- store_temp_max_hyst, 0, 0),
- SENSOR_ATTR_2(temp1_crit, S_IRUGO|S_IWUSR, show_temp_crit,
- store_temp_crit, 0, 0),
- SENSOR_ATTR_2(temp1_crit_hyst, S_IRUGO, show_temp_crit_hyst, NULL,
- 0, 0),
- SENSOR_ATTR_2(temp1_type, S_IRUGO, show_temp_type, NULL, 0, 0),
- SENSOR_ATTR_2(temp1_beep, S_IRUGO|S_IWUSR, show_temp_beep,
- store_temp_beep, 0, 0),
- SENSOR_ATTR_2(temp1_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 0),
- SENSOR_ATTR_2(temp1_fault, S_IRUGO, show_temp_fault, NULL, 0, 0),
- SENSOR_ATTR_2(temp2_input, S_IRUGO, show_temp, NULL, 0, 1),
- SENSOR_ATTR_2(temp2_max, S_IRUGO|S_IWUSR, show_temp_max,
- store_temp_max, 0, 1),
- SENSOR_ATTR_2(temp2_max_hyst, S_IRUGO|S_IWUSR, show_temp_max_hyst,
- store_temp_max_hyst, 0, 1),
- SENSOR_ATTR_2(temp2_crit, S_IRUGO|S_IWUSR, show_temp_crit,
- store_temp_crit, 0, 1),
- SENSOR_ATTR_2(temp2_crit_hyst, S_IRUGO, show_temp_crit_hyst, NULL,
- 0, 1),
- SENSOR_ATTR_2(temp2_type, S_IRUGO, show_temp_type, NULL, 0, 1),
- SENSOR_ATTR_2(temp2_beep, S_IRUGO|S_IWUSR, show_temp_beep,
- store_temp_beep, 0, 1),
- SENSOR_ATTR_2(temp2_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 1),
- SENSOR_ATTR_2(temp2_fault, S_IRUGO, show_temp_fault, NULL, 0, 1),
- SENSOR_ATTR_2(temp3_input, S_IRUGO, show_temp, NULL, 0, 2),
- SENSOR_ATTR_2(temp3_max, S_IRUGO|S_IWUSR, show_temp_max,
- store_temp_max, 0, 2),
- SENSOR_ATTR_2(temp3_max_hyst, S_IRUGO|S_IWUSR, show_temp_max_hyst,
- store_temp_max_hyst, 0, 2),
- SENSOR_ATTR_2(temp3_crit, S_IRUGO|S_IWUSR, show_temp_crit,
- store_temp_crit, 0, 2),
- SENSOR_ATTR_2(temp3_crit_hyst, S_IRUGO, show_temp_crit_hyst, NULL,
- 0, 2),
- SENSOR_ATTR_2(temp3_type, S_IRUGO, show_temp_type, NULL, 0, 2),
- SENSOR_ATTR_2(temp3_beep, S_IRUGO|S_IWUSR, show_temp_beep,
- store_temp_beep, 0, 2),
- SENSOR_ATTR_2(temp3_alarm, S_IRUGO, show_temp_alarm, NULL, 0, 2),
- SENSOR_ATTR_2(temp3_fault, S_IRUGO, show_temp_fault, NULL, 0, 2),
- };
- static struct sensor_device_attribute_2 f71882fg_in_temp_attr[] = {
- SENSOR_ATTR_2(in1_max, S_IRUGO|S_IWUSR, show_in_max, store_in_max,
- 0, 1),
- SENSOR_ATTR_2(in1_beep, S_IRUGO|S_IWUSR, show_in_beep, store_in_beep,
- 0, 1),
- SENSOR_ATTR_2(in1_alarm, S_IRUGO, show_in_alarm, NULL, 0, 1),
- };
- static struct sensor_device_attribute_2 f718x2fg_fan_attr[] = {
- SENSOR_ATTR_2(fan1_input, S_IRUGO, show_fan, NULL, 0, 0),
- SENSOR_ATTR_2(fan1_full_speed, S_IRUGO|S_IWUSR,
- show_fan_full_speed,
- store_fan_full_speed, 0, 0),
- SENSOR_ATTR_2(fan1_beep, S_IRUGO|S_IWUSR, show_fan_beep,
- store_fan_beep, 0, 0),
- SENSOR_ATTR_2(fan1_alarm, S_IRUGO, show_fan_alarm, NULL, 0, 0),
- SENSOR_ATTR_2(fan2_input, S_IRUGO, show_fan, NULL, 0, 1),
- SENSOR_ATTR_2(fan2_full_speed, S_IRUGO|S_IWUSR,
- show_fan_full_speed,
- store_fan_full_speed, 0, 1),
- SENSOR_ATTR_2(fan2_beep, S_IRUGO|S_IWUSR, show_fan_beep,
- store_fan_beep, 0, 1),
- SENSOR_ATTR_2(fan2_alarm, S_IRUGO, show_fan_alarm, NULL, 0, 1),
- SENSOR_ATTR_2(fan3_input, S_IRUGO, show_fan, NULL, 0, 2),
- SENSOR_ATTR_2(fan3_full_speed, S_IRUGO|S_IWUSR,
- show_fan_full_speed,
- store_fan_full_speed, 0, 2),
- SENSOR_ATTR_2(fan3_beep, S_IRUGO|S_IWUSR, show_fan_beep,
- store_fan_beep, 0, 2),
- SENSOR_ATTR_2(fan3_alarm, S_IRUGO, show_fan_alarm, NULL, 0, 2),
- SENSOR_ATTR_2(pwm1, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0, 0),
- SENSOR_ATTR_2(pwm1_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
- store_pwm_enable, 0, 0),
- SENSOR_ATTR_2(pwm1_interpolate, S_IRUGO|S_IWUSR,
- show_pwm_interpolate, store_pwm_interpolate, 0, 0),
- SENSOR_ATTR_2(pwm1_auto_channels_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_channel,
- store_pwm_auto_point_channel, 0, 0),
- SENSOR_ATTR_2(pwm2, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0, 1),
- SENSOR_ATTR_2(pwm2_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
- store_pwm_enable, 0, 1),
- SENSOR_ATTR_2(pwm2_interpolate, S_IRUGO|S_IWUSR,
- show_pwm_interpolate, store_pwm_interpolate, 0, 1),
- SENSOR_ATTR_2(pwm2_auto_channels_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_channel,
- store_pwm_auto_point_channel, 0, 1),
- SENSOR_ATTR_2(pwm3, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0, 2),
- SENSOR_ATTR_2(pwm3_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
- store_pwm_enable, 0, 2),
- SENSOR_ATTR_2(pwm3_interpolate, S_IRUGO|S_IWUSR,
- show_pwm_interpolate, store_pwm_interpolate, 0, 2),
- SENSOR_ATTR_2(pwm3_auto_channels_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_channel,
- store_pwm_auto_point_channel, 0, 2),
- };
- static struct sensor_device_attribute_2 f71862fg_fan_attr[] = {
- SENSOR_ATTR_2(pwm1_auto_point1_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 1, 0),
- SENSOR_ATTR_2(pwm1_auto_point2_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 4, 0),
- SENSOR_ATTR_2(pwm1_auto_point1_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 0, 0),
- SENSOR_ATTR_2(pwm1_auto_point2_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 3, 0),
- SENSOR_ATTR_2(pwm1_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp_hyst,
- store_pwm_auto_point_temp_hyst,
- 0, 0),
- SENSOR_ATTR_2(pwm1_auto_point2_temp_hyst, S_IRUGO,
- show_pwm_auto_point_temp_hyst, NULL, 3, 0),
- SENSOR_ATTR_2(pwm2_auto_point1_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 1, 1),
- SENSOR_ATTR_2(pwm2_auto_point2_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 4, 1),
- SENSOR_ATTR_2(pwm2_auto_point1_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 0, 1),
- SENSOR_ATTR_2(pwm2_auto_point2_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 3, 1),
- SENSOR_ATTR_2(pwm2_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp_hyst,
- store_pwm_auto_point_temp_hyst,
- 0, 1),
- SENSOR_ATTR_2(pwm2_auto_point2_temp_hyst, S_IRUGO,
- show_pwm_auto_point_temp_hyst, NULL, 3, 1),
- };
- static struct sensor_device_attribute_2 f71882fg_fan_attr[] = {
- SENSOR_ATTR_2(fan4_input, S_IRUGO, show_fan, NULL, 0, 3),
- SENSOR_ATTR_2(fan4_full_speed, S_IRUGO|S_IWUSR,
- show_fan_full_speed,
- store_fan_full_speed, 0, 3),
- SENSOR_ATTR_2(fan4_beep, S_IRUGO|S_IWUSR, show_fan_beep,
- store_fan_beep, 0, 3),
- SENSOR_ATTR_2(fan4_alarm, S_IRUGO, show_fan_alarm, NULL, 0, 3),
- SENSOR_ATTR_2(pwm1_auto_point1_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 0, 0),
- SENSOR_ATTR_2(pwm1_auto_point2_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 1, 0),
- SENSOR_ATTR_2(pwm1_auto_point3_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 2, 0),
- SENSOR_ATTR_2(pwm1_auto_point4_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 3, 0),
- SENSOR_ATTR_2(pwm1_auto_point5_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 4, 0),
- SENSOR_ATTR_2(pwm1_auto_point1_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 0, 0),
- SENSOR_ATTR_2(pwm1_auto_point2_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 1, 0),
- SENSOR_ATTR_2(pwm1_auto_point3_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 2, 0),
- SENSOR_ATTR_2(pwm1_auto_point4_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 3, 0),
- SENSOR_ATTR_2(pwm1_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp_hyst,
- store_pwm_auto_point_temp_hyst,
- 0, 0),
- SENSOR_ATTR_2(pwm1_auto_point2_temp_hyst, S_IRUGO,
- show_pwm_auto_point_temp_hyst, NULL, 1, 0),
- SENSOR_ATTR_2(pwm1_auto_point3_temp_hyst, S_IRUGO,
- show_pwm_auto_point_temp_hyst, NULL, 2, 0),
- SENSOR_ATTR_2(pwm1_auto_point4_temp_hyst, S_IRUGO,
- show_pwm_auto_point_temp_hyst, NULL, 3, 0),
- SENSOR_ATTR_2(pwm2_auto_point1_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 0, 1),
- SENSOR_ATTR_2(pwm2_auto_point2_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 1, 1),
- SENSOR_ATTR_2(pwm2_auto_point3_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 2, 1),
- SENSOR_ATTR_2(pwm2_auto_point4_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 3, 1),
- SENSOR_ATTR_2(pwm2_auto_point5_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 4, 1),
- SENSOR_ATTR_2(pwm2_auto_point1_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 0, 1),
- SENSOR_ATTR_2(pwm2_auto_point2_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 1, 1),
- SENSOR_ATTR_2(pwm2_auto_point3_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 2, 1),
- SENSOR_ATTR_2(pwm2_auto_point4_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 3, 1),
- SENSOR_ATTR_2(pwm2_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp_hyst,
- store_pwm_auto_point_temp_hyst,
- 0, 1),
- SENSOR_ATTR_2(pwm2_auto_point2_temp_hyst, S_IRUGO,
- show_pwm_auto_point_temp_hyst, NULL, 1, 1),
- SENSOR_ATTR_2(pwm2_auto_point3_temp_hyst, S_IRUGO,
- show_pwm_auto_point_temp_hyst, NULL, 2, 1),
- SENSOR_ATTR_2(pwm2_auto_point4_temp_hyst, S_IRUGO,
- show_pwm_auto_point_temp_hyst, NULL, 3, 1),
- SENSOR_ATTR_2(pwm3_auto_point1_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 0, 2),
- SENSOR_ATTR_2(pwm3_auto_point2_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 1, 2),
- SENSOR_ATTR_2(pwm3_auto_point3_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 2, 2),
- SENSOR_ATTR_2(pwm3_auto_point4_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 3, 2),
- SENSOR_ATTR_2(pwm3_auto_point5_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 4, 2),
- SENSOR_ATTR_2(pwm3_auto_point1_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 0, 2),
- SENSOR_ATTR_2(pwm3_auto_point2_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 1, 2),
- SENSOR_ATTR_2(pwm3_auto_point3_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 2, 2),
- SENSOR_ATTR_2(pwm3_auto_point4_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 3, 2),
- SENSOR_ATTR_2(pwm3_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp_hyst,
- store_pwm_auto_point_temp_hyst,
- 0, 2),
- SENSOR_ATTR_2(pwm3_auto_point2_temp_hyst, S_IRUGO,
- show_pwm_auto_point_temp_hyst, NULL, 1, 2),
- SENSOR_ATTR_2(pwm3_auto_point3_temp_hyst, S_IRUGO,
- show_pwm_auto_point_temp_hyst, NULL, 2, 2),
- SENSOR_ATTR_2(pwm3_auto_point4_temp_hyst, S_IRUGO,
- show_pwm_auto_point_temp_hyst, NULL, 3, 2),
- SENSOR_ATTR_2(pwm4, S_IRUGO|S_IWUSR, show_pwm, store_pwm, 0, 3),
- SENSOR_ATTR_2(pwm4_enable, S_IRUGO|S_IWUSR, show_pwm_enable,
- store_pwm_enable, 0, 3),
- SENSOR_ATTR_2(pwm4_interpolate, S_IRUGO|S_IWUSR,
- show_pwm_interpolate, store_pwm_interpolate, 0, 3),
- SENSOR_ATTR_2(pwm4_auto_channels_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_channel,
- store_pwm_auto_point_channel, 0, 3),
- SENSOR_ATTR_2(pwm4_auto_point1_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 0, 3),
- SENSOR_ATTR_2(pwm4_auto_point2_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 1, 3),
- SENSOR_ATTR_2(pwm4_auto_point3_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 2, 3),
- SENSOR_ATTR_2(pwm4_auto_point4_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 3, 3),
- SENSOR_ATTR_2(pwm4_auto_point5_pwm, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_pwm, store_pwm_auto_point_pwm,
- 4, 3),
- SENSOR_ATTR_2(pwm4_auto_point1_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 0, 3),
- SENSOR_ATTR_2(pwm4_auto_point2_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 1, 3),
- SENSOR_ATTR_2(pwm4_auto_point3_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 2, 3),
- SENSOR_ATTR_2(pwm4_auto_point4_temp, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp, store_pwm_auto_point_temp,
- 3, 3),
- SENSOR_ATTR_2(pwm4_auto_point1_temp_hyst, S_IRUGO|S_IWUSR,
- show_pwm_auto_point_temp_hyst,
- store_pwm_auto_point_temp_hyst,
- 0, 3),
- SENSOR_ATTR_2(pwm4_auto_point2_temp_hyst, S_IRUGO,
- show_pwm_auto_point_temp_hyst, NULL, 1, 3),
- SENSOR_ATTR_2(pwm4_auto_point3_temp_hyst, S_IRUGO,
- show_pwm_auto_point_temp_hyst, NULL, 2, 3),
- SENSOR_ATTR_2(pwm4_auto_point4_temp_hyst, S_IRUGO,
- show_pwm_auto_point_temp_hyst, NULL, 3, 3),
- };
- /* Super I/O functions */
- static inline int superio_inb(int base, int reg)
- {
- outb(reg, base);
- return inb(base + 1);
- }
- static int superio_inw(int base, int reg)
- {
- int val;
- outb(reg++, base);
- val = inb(base + 1) << 8;
- outb(reg, base);
- val |= inb(base + 1);
- return val;
- }
- static inline void superio_enter(int base)
- {
- /* according to the datasheet the key must be send twice! */
- outb( SIO_UNLOCK_KEY, base);
- outb( SIO_UNLOCK_KEY, base);
- }
- static inline void superio_select( int base, int ld)
- {
- outb(SIO_REG_LDSEL, base);
- outb(ld, base + 1);
- }
- static inline void superio_exit(int base)
- {
- outb(SIO_LOCK_KEY, base);
- }
- static inline u16 fan_from_reg(u16 reg)
- {
- return reg ? (1500000 / reg) : 0;
- }
- static inline u16 fan_to_reg(u16 fan)
- {
- return fan ? (1500000 / fan) : 0;
- }
- static u8 f71882fg_read8(struct f71882fg_data *data, u8 reg)
- {
- u8 val;
- outb(reg, data->addr + ADDR_REG_OFFSET);
- val = inb(data->addr + DATA_REG_OFFSET);
- return val;
- }
- static u16 f71882fg_read16(struct f71882fg_data *data, u8 reg)
- {
- u16 val;
- outb(reg++, data->addr + ADDR_REG_OFFSET);
- val = inb(data->addr + DATA_REG_OFFSET) << 8;
- outb(reg, data->addr + ADDR_REG_OFFSET);
- val |= inb(data->addr + DATA_REG_OFFSET);
- return val;
- }
- static void f71882fg_write8(struct f71882fg_data *data, u8 reg, u8 val)
- {
- outb(reg, data->addr + ADDR_REG_OFFSET);
- outb(val, data->addr + DATA_REG_OFFSET);
- }
- static void f71882fg_write16(struct f71882fg_data *data, u8 reg, u16 val)
- {
- outb(reg++, data->addr + ADDR_REG_OFFSET);
- outb(val >> 8, data->addr + DATA_REG_OFFSET);
- outb(reg, data->addr + ADDR_REG_OFFSET);
- outb(val & 255, data->addr + DATA_REG_OFFSET);
- }
- static struct f71882fg_data *f71882fg_update_device(struct device *dev)
- {
- struct f71882fg_data *data = dev_get_drvdata(dev);
- int nr, reg, reg2;
- int nr_fans = (data->type == f71862fg) ? 3 : 4;
- mutex_lock(&data->update_lock);
- /* Update once every 60 seconds */
- if ( time_after(jiffies, data->last_limits + 60 * HZ ) ||
- !data->valid) {
- if (data->type == f71882fg) {
- data->in1_max =
- f71882fg_read8(data, F71882FG_REG_IN1_HIGH);
- data->in_beep =
- f71882fg_read8(data, F71882FG_REG_IN_BEEP);
- }
- /* Get High & boundary temps*/
- for (nr = 0; nr < 3; nr++) {
- data->temp_ovt[nr] = f71882fg_read8(data,
- F71882FG_REG_TEMP_OVT(nr));
- data->temp_high[nr] = f71882fg_read8(data,
- F71882FG_REG_TEMP_HIGH(nr));
- }
- /* Have to hardcode hyst*/
- data->temp_hyst[0] = f71882fg_read8(data,
- F71882FG_REG_TEMP_HYST1) >> 4;
- /* Hyst temps 2 & 3 stored in same register */
- reg = f71882fg_read8(data, F71882FG_REG_TEMP_HYST23);
- data->temp_hyst[1] = reg & 0x0F;
- data->temp_hyst[2] = reg >> 4;
- /* Have to hardcode type, because temp1 is special */
- reg = f71882fg_read8(data, F71882FG_REG_TEMP_TYPE);
- reg2 = f71882fg_read8(data, F71882FG_REG_PECI);
- if ((reg2 & 0x03) == 0x01)
- data->temp_type[0] = 6 /* PECI */;
- else if ((reg2 & 0x03) == 0x02)
- data->temp_type[0] = 5 /* AMDSI */;
- else
- data->temp_type[0] = (reg & 0x02) ? 2 : 4;
- data->temp_type[1] = (reg & 0x04) ? 2 : 4;
- data->temp_type[2] = (reg & 0x08) ? 2 : 4;
- data->temp_beep = f71882fg_read8(data, F71882FG_REG_TEMP_BEEP);
- data->fan_beep = f71882fg_read8(data, F71882FG_REG_FAN_BEEP);
- data->pwm_enable = f71882fg_read8(data,
- F71882FG_REG_PWM_ENABLE);
- data->pwm_auto_point_hyst[0] = f71882fg_read8(data,
- F71882FG_REG_FAN_HYST0);
- data->pwm_auto_point_hyst[1] = f71882fg_read8(data,
- F71882FG_REG_FAN_HYST1);
- for (nr = 0; nr < nr_fans; nr++) {
- data->pwm_auto_point_mapping[nr] =
- f71882fg_read8(data,
- F71882FG_REG_POINT_MAPPING(nr));
- if (data->type == f71882fg) {
- int point;
- for (point = 0; point < 5; point++) {
- data->pwm_auto_point_pwm[nr][point] =
- f71882fg_read8(data,
- F71882FG_REG_POINT_PWM
- (nr, point));
- }
- for (point = 0; point < 4; point++) {
- data->pwm_auto_point_temp[nr][point] =
- f71882fg_read8(data,
- F71882FG_REG_POINT_TEMP
- (nr, point));
- }
- } else {
- data->pwm_auto_point_pwm[nr][1] =
- f71882fg_read8(data,
- F71882FG_REG_POINT_PWM
- (nr, 1));
- data->pwm_auto_point_pwm[nr][4] =
- f71882fg_read8(data,
- F71882FG_REG_POINT_PWM
- (nr, 4));
- data->pwm_auto_point_temp[nr][0] =
- f71882fg_read8(data,
- F71882FG_REG_POINT_TEMP
- (nr, 0));
- data->pwm_auto_point_temp[nr][3] =
- f71882fg_read8(data,
- F71882FG_REG_POINT_TEMP
- (nr, 3));
- }
- }
- data->last_limits = jiffies;
- }
- /* Update every second */
- if (time_after(jiffies, data->last_updated + HZ) || !data->valid) {
- data->temp_status = f71882fg_read8(data,
- F71882FG_REG_TEMP_STATUS);
- data->temp_diode_open = f71882fg_read8(data,
- F71882FG_REG_TEMP_DIODE_OPEN);
- for (nr = 0; nr < 3; nr++)
- data->temp[nr] = f71882fg_read8(data,
- F71882FG_REG_TEMP(nr));
- data->fan_status = f71882fg_read8(data,
- F71882FG_REG_FAN_STATUS);
- for (nr = 0; nr < nr_fans; nr++) {
- data->fan[nr] = f71882fg_read16(data,
- F71882FG_REG_FAN(nr));
- data->fan_target[nr] =
- f71882fg_read16(data, F71882FG_REG_FAN_TARGET(nr));
- data->fan_full_speed[nr] =
- f71882fg_read16(data,
- F71882FG_REG_FAN_FULL_SPEED(nr));
- data->pwm[nr] =
- f71882fg_read8(data, F71882FG_REG_PWM(nr));
- }
- if (data->type == f71882fg)
- data->in_status = f71882fg_read8(data,
- F71882FG_REG_IN_STATUS);
- for (nr = 0; nr < 9; nr++)
- data->in[nr] = f71882fg_read8(data,
- F71882FG_REG_IN(nr));
- data->last_updated = jiffies;
- data->valid = 1;
- }
- mutex_unlock(&data->update_lock);
- return data;
- }
- /* Sysfs Interface */
- static ssize_t show_fan(struct device *dev, struct device_attribute *devattr,
- char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- int speed = fan_from_reg(data->fan[nr]);
- if (speed == FAN_MIN_DETECT)
- speed = 0;
- return sprintf(buf, "%d\n", speed);
- }
- static ssize_t show_fan_full_speed(struct device *dev,
- struct device_attribute *devattr, char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- int speed = fan_from_reg(data->fan_full_speed[nr]);
- return sprintf(buf, "%d\n", speed);
- }
- static ssize_t store_fan_full_speed(struct device *dev,
- struct device_attribute *devattr,
- const char *buf, size_t count)
- {
- struct f71882fg_data *data = dev_get_drvdata(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- long val = simple_strtol(buf, NULL, 10);
- val = SENSORS_LIMIT(val, 23, 1500000);
- val = fan_to_reg(val);
- mutex_lock(&data->update_lock);
- if (data->pwm_enable & (1 << (2 * nr)))
- /* PWM mode */
- count = -EINVAL;
- else {
- /* RPM mode */
- f71882fg_write16(data, F71882FG_REG_FAN_FULL_SPEED(nr), val);
- data->fan_full_speed[nr] = val;
- }
- mutex_unlock(&data->update_lock);
- return count;
- }
- static ssize_t show_fan_beep(struct device *dev, struct device_attribute
- *devattr, char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- if (data->fan_beep & (1 << nr))
- return sprintf(buf, "1\n");
- else
- return sprintf(buf, "0\n");
- }
- static ssize_t store_fan_beep(struct device *dev, struct device_attribute
- *devattr, const char *buf, size_t count)
- {
- struct f71882fg_data *data = dev_get_drvdata(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- int val = simple_strtoul(buf, NULL, 10);
- mutex_lock(&data->update_lock);
- if (val)
- data->fan_beep |= 1 << nr;
- else
- data->fan_beep &= ~(1 << nr);
- f71882fg_write8(data, F71882FG_REG_FAN_BEEP, data->fan_beep);
- mutex_unlock(&data->update_lock);
- return count;
- }
- static ssize_t show_fan_alarm(struct device *dev, struct device_attribute
- *devattr, char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- if (data->fan_status & (1 << nr))
- return sprintf(buf, "1\n");
- else
- return sprintf(buf, "0\n");
- }
- static ssize_t show_in(struct device *dev, struct device_attribute *devattr,
- char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- return sprintf(buf, "%d\n", data->in[nr] * 8);
- }
- static ssize_t show_in_max(struct device *dev, struct device_attribute
- *devattr, char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- return sprintf(buf, "%d\n", data->in1_max * 8);
- }
- static ssize_t store_in_max(struct device *dev, struct device_attribute
- *devattr, const char *buf, size_t count)
- {
- struct f71882fg_data *data = dev_get_drvdata(dev);
- int val = simple_strtoul(buf, NULL, 10) / 8;
- if (val > 255)
- val = 255;
- mutex_lock(&data->update_lock);
- f71882fg_write8(data, F71882FG_REG_IN1_HIGH, val);
- data->in1_max = val;
- mutex_unlock(&data->update_lock);
- return count;
- }
- static ssize_t show_in_beep(struct device *dev, struct device_attribute
- *devattr, char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- if (data->in_beep & (1 << nr))
- return sprintf(buf, "1\n");
- else
- return sprintf(buf, "0\n");
- }
- static ssize_t store_in_beep(struct device *dev, struct device_attribute
- *devattr, const char *buf, size_t count)
- {
- struct f71882fg_data *data = dev_get_drvdata(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- int val = simple_strtoul(buf, NULL, 10);
- mutex_lock(&data->update_lock);
- if (val)
- data->in_beep |= 1 << nr;
- else
- data->in_beep &= ~(1 << nr);
- f71882fg_write8(data, F71882FG_REG_IN_BEEP, data->in_beep);
- mutex_unlock(&data->update_lock);
- return count;
- }
- static ssize_t show_in_alarm(struct device *dev, struct device_attribute
- *devattr, char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- if (data->in_status & (1 << nr))
- return sprintf(buf, "1\n");
- else
- return sprintf(buf, "0\n");
- }
- static ssize_t show_temp(struct device *dev, struct device_attribute *devattr,
- char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- return sprintf(buf, "%d\n", data->temp[nr] * 1000);
- }
- static ssize_t show_temp_max(struct device *dev, struct device_attribute
- *devattr, char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- return sprintf(buf, "%d\n", data->temp_high[nr] * 1000);
- }
- static ssize_t store_temp_max(struct device *dev, struct device_attribute
- *devattr, const char *buf, size_t count)
- {
- struct f71882fg_data *data = dev_get_drvdata(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- int val = simple_strtoul(buf, NULL, 10) / 1000;
- if (val > 255)
- val = 255;
- mutex_lock(&data->update_lock);
- f71882fg_write8(data, F71882FG_REG_TEMP_HIGH(nr), val);
- data->temp_high[nr] = val;
- mutex_unlock(&data->update_lock);
- return count;
- }
- static ssize_t show_temp_max_hyst(struct device *dev, struct device_attribute
- *devattr, char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- return sprintf(buf, "%d\n",
- (data->temp_high[nr] - data->temp_hyst[nr]) * 1000);
- }
- static ssize_t store_temp_max_hyst(struct device *dev, struct device_attribute
- *devattr, const char *buf, size_t count)
- {
- struct f71882fg_data *data = dev_get_drvdata(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- int val = simple_strtoul(buf, NULL, 10) / 1000;
- ssize_t ret = count;
- mutex_lock(&data->update_lock);
- /* convert abs to relative and check */
- val = data->temp_high[nr] - val;
- if (val < 0 || val > 15) {
- ret = -EINVAL;
- goto store_temp_max_hyst_exit;
- }
- data->temp_hyst[nr] = val;
- /* convert value to register contents */
- switch (nr) {
- case 0:
- val = val << 4;
- break;
- case 1:
- val = val | (data->temp_hyst[2] << 4);
- break;
- case 2:
- val = data->temp_hyst[1] | (val << 4);
- break;
- }
- f71882fg_write8(data, nr ? F71882FG_REG_TEMP_HYST23 :
- F71882FG_REG_TEMP_HYST1, val);
- store_temp_max_hyst_exit:
- mutex_unlock(&data->update_lock);
- return ret;
- }
- static ssize_t show_temp_crit(struct device *dev, struct device_attribute
- *devattr, char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- return sprintf(buf, "%d\n", data->temp_ovt[nr] * 1000);
- }
- static ssize_t store_temp_crit(struct device *dev, struct device_attribute
- *devattr, const char *buf, size_t count)
- {
- struct f71882fg_data *data = dev_get_drvdata(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- int val = simple_strtoul(buf, NULL, 10) / 1000;
- if (val > 255)
- val = 255;
- mutex_lock(&data->update_lock);
- f71882fg_write8(data, F71882FG_REG_TEMP_OVT(nr), val);
- data->temp_ovt[nr] = val;
- mutex_unlock(&data->update_lock);
- return count;
- }
- static ssize_t show_temp_crit_hyst(struct device *dev, struct device_attribute
- *devattr, char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- return sprintf(buf, "%d\n",
- (data->temp_ovt[nr] - data->temp_hyst[nr]) * 1000);
- }
- static ssize_t show_temp_type(struct device *dev, struct device_attribute
- *devattr, char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- return sprintf(buf, "%d\n", data->temp_type[nr]);
- }
- static ssize_t show_temp_beep(struct device *dev, struct device_attribute
- *devattr, char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- if (data->temp_beep & (1 << (nr + 1)))
- return sprintf(buf, "1\n");
- else
- return sprintf(buf, "0\n");
- }
- static ssize_t store_temp_beep(struct device *dev, struct device_attribute
- *devattr, const char *buf, size_t count)
- {
- struct f71882fg_data *data = dev_get_drvdata(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- int val = simple_strtoul(buf, NULL, 10);
- mutex_lock(&data->update_lock);
- if (val)
- data->temp_beep |= 1 << (nr + 1);
- else
- data->temp_beep &= ~(1 << (nr + 1));
- f71882fg_write8(data, F71882FG_REG_TEMP_BEEP, data->temp_beep);
- mutex_unlock(&data->update_lock);
- return count;
- }
- static ssize_t show_temp_alarm(struct device *dev, struct device_attribute
- *devattr, char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- if (data->temp_status & (1 << (nr + 1)))
- return sprintf(buf, "1\n");
- else
- return sprintf(buf, "0\n");
- }
- static ssize_t show_temp_fault(struct device *dev, struct device_attribute
- *devattr, char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- if (data->temp_diode_open & (1 << (nr + 1)))
- return sprintf(buf, "1\n");
- else
- return sprintf(buf, "0\n");
- }
- static ssize_t show_pwm(struct device *dev,
- struct device_attribute *devattr, char *buf)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int val, nr = to_sensor_dev_attr_2(devattr)->index;
- if (data->pwm_enable & (1 << (2 * nr)))
- /* PWM mode */
- val = data->pwm[nr];
- else {
- /* RPM mode */
- mutex_lock(&data->update_lock);
- val = 255 * fan_from_reg(data->fan_target[nr])
- / fan_from_reg(data->fan_full_speed[nr]);
- mutex_unlock(&data->update_lock);
- }
- return sprintf(buf, "%d\n", val);
- }
- static ssize_t store_pwm(struct device *dev,
- struct device_attribute *devattr, const char *buf,
- size_t count)
- {
- /* struct f71882fg_data *data = dev_get_drvdata(dev); */
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- long val = simple_strtol(buf, NULL, 10);
- val = SENSORS_LIMIT(val, 0, 255);
- mutex_lock(&data->update_lock);
- if (data->pwm_enable & (1 << (2 * nr))) {
- /* PWM mode */
- f71882fg_write8(data, F71882FG_REG_PWM(nr), val);
- data->pwm[nr] = val;
- } else {
- /* RPM mode */
- int target = val * fan_from_reg(data->fan_full_speed[nr]) / 255;
- f71882fg_write16(data, F71882FG_REG_FAN_TARGET(nr),
- fan_to_reg(target));
- data->fan_target[nr] = fan_to_reg(target);
- }
- mutex_unlock(&data->update_lock);
- return count;
- }
- static ssize_t show_pwm_enable(struct device *dev,
- struct device_attribute *devattr, char *buf)
- {
- int result;
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- if (data->pwm_enable & (2 << (2 * nr)))
- result = 1;
- else
- result = 2;
- return sprintf(buf, "%d\n", result);
- }
- static ssize_t store_pwm_enable(struct device *dev, struct device_attribute
- *devattr, const char *buf, size_t count)
- {
- struct f71882fg_data *data = dev_get_drvdata(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- long val = simple_strtol(buf, NULL, 10);
- if (val < 1 || val > 2)
- return -EINVAL;
- mutex_lock(&data->update_lock);
- switch (val) {
- case 1:
- data->pwm_enable |= 2 << (2 * nr);
- break; /* Manual */
- case 2:
- data->pwm_enable &= ~(2 << (2 * nr));
- break; /* Temperature ctrl */
- }
- if (data->type == f71882fg) {
- switch (fan_mode[nr]) {
- case 1:
- data->pwm_enable |= 1 << (2 * nr);
- break; /* Duty cycle mode */
- case 2:
- data->pwm_enable &= ~(1 << (2 * nr));
- break; /* RPM mode */
- }
- }
- f71882fg_write8(data, F71882FG_REG_PWM_ENABLE, data->pwm_enable);
- mutex_unlock(&data->update_lock);
- return count;
- }
- static ssize_t show_pwm_auto_point_pwm(struct device *dev,
- struct device_attribute *devattr,
- char *buf)
- {
- int result;
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int pwm = to_sensor_dev_attr_2(devattr)->index;
- int point = to_sensor_dev_attr_2(devattr)->nr;
- if (data->pwm_enable & (1 << (2 * pwm))) {
- /* PWM mode */
- result = data->pwm_auto_point_pwm[pwm][point];
- } else {
- /* RPM mode */
- result = 32 * 255 / (32 + data->pwm_auto_point_pwm[pwm][point]);
- }
- return sprintf(buf, "%d\n", result);
- }
- static ssize_t store_pwm_auto_point_pwm(struct device *dev,
- struct device_attribute *devattr,
- const char *buf, size_t count)
- {
- /* struct f71882fg_data *data = dev_get_drvdata(dev); */
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int pwm = to_sensor_dev_attr_2(devattr)->index;
- int point = to_sensor_dev_attr_2(devattr)->nr;
- int val = simple_strtoul(buf, NULL, 10);
- val = SENSORS_LIMIT(val, 0, 255);
- mutex_lock(&data->update_lock);
- if (data->pwm_enable & (1 << (2 * pwm))) {
- /* PWM mode */
- } else {
- /* RPM mode */
- if (val < 29) /* Prevent negative numbers */
- val = 255;
- else
- val = (255 - val) * 32 / val;
- }
- f71882fg_write8(data, F71882FG_REG_POINT_PWM(pwm, point), val);
- data->pwm_auto_point_pwm[pwm][point] = val;
- mutex_unlock(&data->update_lock);
- return count;
- }
- static ssize_t show_pwm_auto_point_temp_hyst(struct device *dev,
- struct device_attribute *devattr,
- char *buf)
- {
- int result = 0;
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- int point = to_sensor_dev_attr_2(devattr)->nr;
- mutex_lock(&data->update_lock);
- switch (nr) {
- case 0:
- result = data->pwm_auto_point_hyst[0] & 0x0f;
- break;
- case 1:
- result = data->pwm_auto_point_hyst[0] >> 4;
- break;
- case 2:
- result = data->pwm_auto_point_hyst[1] & 0x0f;
- break;
- case 3:
- result = data->pwm_auto_point_hyst[1] >> 4;
- break;
- }
- result = 1000 * (data->pwm_auto_point_temp[nr][point] - result);
- mutex_unlock(&data->update_lock);
- return sprintf(buf, "%d\n", result);
- }
- static ssize_t store_pwm_auto_point_temp_hyst(struct device *dev,
- struct device_attribute *devattr,
- const char *buf, size_t count)
- {
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- int point = to_sensor_dev_attr_2(devattr)->nr;
- long val = simple_strtol(buf, NULL, 10) / 1000;
- mutex_lock(&data->update_lock);
- val = SENSORS_LIMIT(val, data->pwm_auto_point_temp[nr][point] - 15,
- data->pwm_auto_point_temp[nr][point]);
- val = data->pwm_auto_point_temp[nr][point] - val;
- switch (nr) {
- case 0:
- val = (data->pwm_auto_point_hyst[0] & 0xf0) | val;
- break;
- case 1:
- val = (data->pwm_auto_point_hyst[0] & 0x0f) | (val << 4);
- break;
- case 2:
- val = (data->pwm_auto_point_hyst[1] & 0xf0) | val;
- break;
- case 3:
- val = (data->pwm_auto_point_hyst[1] & 0x0f) | (val << 4);
- break;
- }
- if (nr == 0 || nr == 1) {
- f71882fg_write8(data, F71882FG_REG_FAN_HYST0, val);
- data->pwm_auto_point_hyst[0] = val;
- } else {
- f71882fg_write8(data, F71882FG_REG_FAN_HYST1, val);
- data->pwm_auto_point_hyst[1] = val;
- }
- mutex_unlock(&data->update_lock);
- return count;
- }
- static ssize_t show_pwm_interpolate(struct device *dev,
- struct device_attribute *devattr, char *buf)
- {
- int result;
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- result = (data->pwm_auto_point_mapping[nr] >> 4) & 1;
- return sprintf(buf, "%d\n", result);
- }
- static ssize_t store_pwm_interpolate(struct device *dev,
- struct device_attribute *devattr,
- const char *buf, size_t count)
- {
- /* struct f71882fg_data *data = dev_get_drvdata(dev); */
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- int val = simple_strtoul(buf, NULL, 10);
- mutex_lock(&data->update_lock);
- if (val)
- val = data->pwm_auto_point_mapping[nr] | (1 << 4);
- else
- val = data->pwm_auto_point_mapping[nr] & (~(1 << 4));
- f71882fg_write8(data, F71882FG_REG_POINT_MAPPING(nr), val);
- data->pwm_auto_point_mapping[nr] = val;
- mutex_unlock(&data->update_lock);
- return count;
- }
- static ssize_t show_pwm_auto_point_channel(struct device *dev,
- struct device_attribute *devattr,
- char *buf)
- {
- int result;
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- result = 1 << ((data->pwm_auto_point_mapping[nr] & 3) - 1);
- return sprintf(buf, "%d\n", result);
- }
- static ssize_t store_pwm_auto_point_channel(struct device *dev,
- struct device_attribute *devattr,
- const char *buf, size_t count)
- {
- /* struct f71882fg_data *data = dev_get_drvdata(dev); */
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int nr = to_sensor_dev_attr_2(devattr)->index;
- long val = simple_strtol(buf, NULL, 10);
- switch (val) {
- case 1:
- val = 1;
- break;
- case 2:
- val = 2;
- break;
- case 4:
- val = 3;
- break;
- default:
- return -EINVAL;
- }
- mutex_lock(&data->update_lock);
- val = (data->pwm_auto_point_mapping[nr] & 0xfc) | val;
- f71882fg_write8(data, F71882FG_REG_POINT_MAPPING(nr), val);
- data->pwm_auto_point_mapping[nr] = val;
- mutex_unlock(&data->update_lock);
- return count;
- }
- static ssize_t show_pwm_auto_point_temp(struct device *dev,
- struct device_attribute *devattr,
- char *buf)
- {
- int result;
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int pwm = to_sensor_dev_attr_2(devattr)->index;
- int point = to_sensor_dev_attr_2(devattr)->nr;
- result = data->pwm_auto_point_temp[pwm][point];
- return sprintf(buf, "%d\n", 1000 * result);
- }
- static ssize_t store_pwm_auto_point_temp(struct device *dev,
- struct device_attribute *devattr,
- const char *buf, size_t count)
- {
- /* struct f71882fg_data *data = dev_get_drvdata(dev); */
- struct f71882fg_data *data = f71882fg_update_device(dev);
- int pwm = to_sensor_dev_attr_2(devattr)->index;
- int point = to_sensor_dev_attr_2(devattr)->nr;
- long val = simple_strtol(buf, NULL, 10) / 1000;
- val = SENSORS_LIMIT(val, 0, 255);
- mutex_lock(&data->update_lock);
- f71882fg_write8(data, F71882FG_REG_POINT_TEMP(pwm, point), val);
- data->pwm_auto_point_temp[pwm][point] = val;
- mutex_unlock(&data->update_lock);
- return count;
- }
- static ssize_t show_name(struct device *dev, struct device_attribute *devattr,
- char *buf)
- {
- struct f71882fg_data *data = dev_get_drvdata(dev);
- return sprintf(buf, "%s\n", f71882fg_names[data->type]);
- }
- static int __devinit f71882fg_create_sysfs_files(struct platform_device *pdev,
- struct sensor_device_attribute_2 *attr, int count)
- {
- int err, i;
- for (i = 0; i < count; i++) {
- err = device_create_file(&pdev->dev, &attr[i].dev_attr);
- if (err)
- return err;
- }
- return 0;
- }
- static int __devinit f71882fg_probe(struct platform_device *pdev)
- {
- struct f71882fg_data *data;
- struct f71882fg_sio_data *sio_data = pdev->dev.platform_data;
- int err;
- u8 start_reg;
- data = kzalloc(sizeof(struct f71882fg_data), GFP_KERNEL);
- if (!data)
- return -ENOMEM;
- data->addr = platform_get_resource(pdev, IORESOURCE_IO, 0)->start;
- data->type = sio_data->type;
- mutex_init(&data->update_lock);
- platform_set_drvdata(pdev, data);
- /* Register sysfs interface files */
- err = device_create_file(&pdev->dev, &dev_attr_name);
- if (err)
- goto exit_unregister_sysfs;
- start_reg = f71882fg_read8(data, F71882FG_REG_START);
- if (start_reg & 0x01) {
- err = f71882fg_create_sysfs_files(pdev, f718x2fg_in_temp_attr,
- ARRAY_SIZE(f718x2fg_in_temp_attr));
- if (err)
- goto exit_unregister_sysfs;
- if (data->type == f71882fg) {
- err = f71882fg_create_sysfs_files(pdev,
- f71882fg_in_temp_attr,
- ARRAY_SIZE(f71882fg_in_temp_attr));
- if (err)
- goto exit_unregister_sysfs;
- }
- }
- if (start_reg & 0x02) {
- err = f71882fg_create_sysfs_files(pdev, f718x2fg_fan_attr,
- ARRAY_SIZE(f718x2fg_fan_attr));
- if (err)
- goto exit_unregister_sysfs;
- if (data->type == f71862fg) {
- err = f71882fg_create_sysfs_files(pdev,
- f71862fg_fan_attr,
- ARRAY_SIZE(f71862fg_fan_attr));
- } else {
- err = f71882fg_create_sysfs_files(pdev,
- f71882fg_fan_attr,
- ARRAY_SIZE(f71882fg_fan_attr));
- }
- if (err)
- goto exit_unregister_sysfs;
- }
- data->hwmon_dev = hwmon_device_register(&pdev->dev);
- if (IS_ERR(data->hwmon_dev)) {
- err = PTR_ERR(data->hwmon_dev);
- data->hwmon_dev = NULL;
- goto exit_unregister_sysfs;
- }
- return 0;
- exit_unregister_sysfs:
- f71882fg_remove(pdev); /* Will unregister the sysfs files for us */
- return err;
- }
- static int f71882fg_remove(struct platform_device *pdev)
- {
- int i;
- struct f71882fg_data *data = platform_get_drvdata(pdev);
- platform_set_drvdata(pdev, NULL);
- if (data->hwmon_dev)
- hwmon_device_unregister(data->hwmon_dev);
- device_remove_file(&pdev->dev, &dev_attr_name);
- for (i = 0; i < ARRAY_SIZE(f718x2fg_in_temp_attr); i++)
- device_remove_file(&pdev->dev,
- &f718x2fg_in_temp_attr[i].dev_attr);
- for (i = 0; i < ARRAY_SIZE(f71882fg_in_temp_attr); i++)
- device_remove_file(&pdev->dev,
- &f71882fg_in_temp_attr[i].dev_attr);
- for (i = 0; i < ARRAY_SIZE(f718x2fg_fan_attr); i++)
- device_remove_file(&pdev->dev, &f718x2fg_fan_attr[i].dev_attr);
- for (i = 0; i < ARRAY_SIZE(f71862fg_fan_attr); i++)
- device_remove_file(&pdev->dev, &f71862fg_fan_attr[i].dev_attr);
- for (i = 0; i < ARRAY_SIZE(f71882fg_fan_attr); i++)
- device_remove_file(&pdev->dev, &f71882fg_fan_attr[i].dev_attr);
- kfree(data);
- return 0;
- }
- static int __init f71882fg_find(int sioaddr, unsigned short *address,
- struct f71882fg_sio_data *sio_data)
- {
- int err = -ENODEV;
- u16 devid;
- u8 reg;
- struct f71882fg_data data;
- superio_enter(sioaddr);
- devid = superio_inw(sioaddr, SIO_REG_MANID);
- if (devid != SIO_FINTEK_ID) {
- printk(KERN_INFO DRVNAME ": Not a Fintek device\n");
- goto exit;
- }
- devid = force_id ? force_id : superio_inw(sioaddr, SIO_REG_DEVID);
- switch (devid) {
- case SIO_F71862_ID:
- sio_data->type = f71862fg;
- break;
- case SIO_F71882_ID:
- sio_data->type = f71882fg;
- break;
- default:
- printk(KERN_INFO DRVNAME ": Unsupported Fintek device\n");
- goto exit;
- }
- superio_select(sioaddr, SIO_F71882FG_LD_HWM);
- if (!(superio_inb(sioaddr, SIO_REG_ENABLE) & 0x01)) {
- printk(KERN_WARNING DRVNAME ": Device not activated\n");
- goto exit;
- }
- *address = superio_inw(sioaddr, SIO_REG_ADDR);
- if (*address == 0)
- {
- printk(KERN_WARNING DRVNAME ": Base address not set\n");
- goto exit;
- }
- *address &= ~(REGION_LENGTH - 1); /* Ignore 3 LSB */
- data.addr = *address;
- reg = f71882fg_read8(&data, F71882FG_REG_START);
- if (!(reg & 0x03)) {
- printk(KERN_WARNING DRVNAME
- ": Hardware monitoring not activated\n");
- goto exit;
- }
- /* If it is a 71862 and the fan / pwm part is enabled sanity check
- the pwm settings */
- if (sio_data->type == f71862fg && (reg & 0x02)) {
- reg = f71882fg_read8(&data, F71882FG_REG_PWM_ENABLE);
- if ((reg & 0x15) != 0x15) {
- printk(KERN_ERR DRVNAME
- ": Invalid (reserved) pwm settings: 0x%02x\n",
- (unsigned int)reg);
- goto exit;
- }
- }
- err = 0;
- printk(KERN_INFO DRVNAME ": Found %s chip at %#x, revision %d\n",
- f71882fg_names[sio_data->type], (unsigned int)*address,
- (int)superio_inb(sioaddr, SIO_REG_DEVREV));
- exit:
- superio_exit(sioaddr);
- return err;
- }
- static int __init f71882fg_device_add(unsigned short address,
- const struct f71882fg_sio_data *sio_data)
- {
- struct resource res = {
- .start = address,
- .end = address + REGION_LENGTH - 1,
- .flags = IORESOURCE_IO,
- };
- int err;
- f71882fg_pdev = platform_device_alloc(DRVNAME, address);
- if (!f71882fg_pdev)
- return -ENOMEM;
- res.name = f71882fg_pdev->name;
- err = platform_device_add_resources(f71882fg_pdev, &res, 1);
- if (err) {
- printk(KERN_ERR DRVNAME ": Device resource addition failed\n");
- goto exit_device_put;
- }
- err = platform_device_add_data(f71882fg_pdev, sio_data,
- sizeof(struct f71882fg_sio_data));
- if (err) {
- printk(KERN_ERR DRVNAME ": Platform data allocation failed\n");
- goto exit_device_put;
- }
- err = platform_device_add(f71882fg_pdev);
- if (err) {
- printk(KERN_ERR DRVNAME ": Device addition failed\n");
- goto exit_device_put;
- }
- return 0;
- exit_device_put:
- platform_device_put(f71882fg_pdev);
- return err;
- }
- static int __init f71882fg_init(void)
- {
- int err = -ENODEV;
- unsigned short address;
- struct f71882fg_sio_data sio_data;
- memset(&sio_data, 0, sizeof(sio_data));
- if (f71882fg_find(0x2e, &address, &sio_data) &&
- f71882fg_find(0x4e, &address, &sio_data))
- goto exit;
- err = platform_driver_register(&f71882fg_driver);
- if (err)
- goto exit;
- err = f71882fg_device_add(address, &sio_data);
- if (err)
- goto exit_driver;
- return 0;
- exit_driver:
- platform_driver_unregister(&f71882fg_driver);
- exit:
- return err;
- }
- static void __exit f71882fg_exit(void)
- {
- platform_device_unregister(f71882fg_pdev);
- platform_driver_unregister(&f71882fg_driver);
- }
- MODULE_DESCRIPTION("F71882FG Hardware Monitoring Driver");
- MODULE_AUTHOR("Hans Edgington, Hans de Goede (hdegoede@redhat.com)");
- MODULE_LICENSE("GPL");
- module_init(f71882fg_init);
- module_exit(f71882fg_exit);
|