123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748 |
- #include <linux/module.h>
- #include <linux/edac.h>
- #include <linux/slab.h>
- #include <linux/ctype.h>
- #include "edac_core.h"
- #include "edac_module.h"
- #define EDAC_PCI_SYMLINK "device"
- static int check_pci_errors;
- static int edac_pci_panic_on_pe;
- static int edac_pci_log_pe = 1;
- static int edac_pci_log_npe = 1;
- static int edac_pci_poll_msec = 1000;
- static atomic_t pci_parity_count = ATOMIC_INIT(0);
- static atomic_t pci_nonparity_count = ATOMIC_INIT(0);
- static struct kobject *edac_pci_top_main_kobj;
- static atomic_t edac_pci_sysfs_refcount = ATOMIC_INIT(0);
- int edac_pci_get_check_errors(void)
- {
- return check_pci_errors;
- }
- static int edac_pci_get_log_pe(void)
- {
- return edac_pci_log_pe;
- }
- static int edac_pci_get_log_npe(void)
- {
- return edac_pci_log_npe;
- }
- static int edac_pci_get_panic_on_pe(void)
- {
- return edac_pci_panic_on_pe;
- }
- int edac_pci_get_poll_msec(void)
- {
- return edac_pci_poll_msec;
- }
- static ssize_t instance_pe_count_show(struct edac_pci_ctl_info *pci, char *data)
- {
- return sprintf(data, "%u\n", atomic_read(&pci->counters.pe_count));
- }
- static ssize_t instance_npe_count_show(struct edac_pci_ctl_info *pci,
- char *data)
- {
- return sprintf(data, "%u\n", atomic_read(&pci->counters.npe_count));
- }
- #define to_instance(k) container_of(k, struct edac_pci_ctl_info, kobj)
- #define to_instance_attr(a) container_of(a, struct instance_attribute, attr)
- static void edac_pci_instance_release(struct kobject *kobj)
- {
- struct edac_pci_ctl_info *pci;
- edac_dbg(0, "\n");
-
- pci = to_instance(kobj);
-
- kobject_put(edac_pci_top_main_kobj);
- kfree(pci);
- }
- struct instance_attribute {
- struct attribute attr;
- ssize_t(*show) (struct edac_pci_ctl_info *, char *);
- ssize_t(*store) (struct edac_pci_ctl_info *, const char *, size_t);
- };
- static ssize_t edac_pci_instance_show(struct kobject *kobj,
- struct attribute *attr, char *buffer)
- {
- struct edac_pci_ctl_info *pci = to_instance(kobj);
- struct instance_attribute *instance_attr = to_instance_attr(attr);
- if (instance_attr->show)
- return instance_attr->show(pci, buffer);
- return -EIO;
- }
- static ssize_t edac_pci_instance_store(struct kobject *kobj,
- struct attribute *attr,
- const char *buffer, size_t count)
- {
- struct edac_pci_ctl_info *pci = to_instance(kobj);
- struct instance_attribute *instance_attr = to_instance_attr(attr);
- if (instance_attr->store)
- return instance_attr->store(pci, buffer, count);
- return -EIO;
- }
- static const struct sysfs_ops pci_instance_ops = {
- .show = edac_pci_instance_show,
- .store = edac_pci_instance_store
- };
- #define INSTANCE_ATTR(_name, _mode, _show, _store) \
- static struct instance_attribute attr_instance_##_name = { \
- .attr = {.name = __stringify(_name), .mode = _mode }, \
- .show = _show, \
- .store = _store, \
- };
- INSTANCE_ATTR(pe_count, S_IRUGO, instance_pe_count_show, NULL);
- INSTANCE_ATTR(npe_count, S_IRUGO, instance_npe_count_show, NULL);
- static struct instance_attribute *pci_instance_attr[] = {
- &attr_instance_pe_count,
- &attr_instance_npe_count,
- NULL
- };
- static struct kobj_type ktype_pci_instance = {
- .release = edac_pci_instance_release,
- .sysfs_ops = &pci_instance_ops,
- .default_attrs = (struct attribute **)pci_instance_attr,
- };
- static int edac_pci_create_instance_kobj(struct edac_pci_ctl_info *pci, int idx)
- {
- struct kobject *main_kobj;
- int err;
- edac_dbg(0, "\n");
-
- main_kobj = kobject_get(edac_pci_top_main_kobj);
- if (!main_kobj) {
- err = -ENODEV;
- goto error_out;
- }
-
- err = kobject_init_and_add(&pci->kobj, &ktype_pci_instance,
- edac_pci_top_main_kobj, "pci%d", idx);
- if (err != 0) {
- edac_dbg(2, "failed to register instance pci%d\n", idx);
- kobject_put(edac_pci_top_main_kobj);
- goto error_out;
- }
- kobject_uevent(&pci->kobj, KOBJ_ADD);
- edac_dbg(1, "Register instance 'pci%d' kobject\n", idx);
- return 0;
-
- error_out:
- return err;
- }
- static void edac_pci_unregister_sysfs_instance_kobj(
- struct edac_pci_ctl_info *pci)
- {
- edac_dbg(0, "\n");
-
- kobject_put(&pci->kobj);
- }
- #define to_edacpci(k) container_of(k, struct edac_pci_ctl_info, kobj)
- #define to_edacpci_attr(a) container_of(a, struct edac_pci_attr, attr)
- static ssize_t edac_pci_int_show(void *ptr, char *buffer)
- {
- int *value = ptr;
- return sprintf(buffer, "%d\n", *value);
- }
- static ssize_t edac_pci_int_store(void *ptr, const char *buffer, size_t count)
- {
- int *value = ptr;
- if (isdigit(*buffer))
- *value = simple_strtoul(buffer, NULL, 0);
- return count;
- }
- struct edac_pci_dev_attribute {
- struct attribute attr;
- void *value;
- ssize_t(*show) (void *, char *);
- ssize_t(*store) (void *, const char *, size_t);
- };
- static ssize_t edac_pci_dev_show(struct kobject *kobj, struct attribute *attr,
- char *buffer)
- {
- struct edac_pci_dev_attribute *edac_pci_dev;
- edac_pci_dev = (struct edac_pci_dev_attribute *)attr;
- if (edac_pci_dev->show)
- return edac_pci_dev->show(edac_pci_dev->value, buffer);
- return -EIO;
- }
- static ssize_t edac_pci_dev_store(struct kobject *kobj,
- struct attribute *attr, const char *buffer,
- size_t count)
- {
- struct edac_pci_dev_attribute *edac_pci_dev;
- edac_pci_dev = (struct edac_pci_dev_attribute *)attr;
- if (edac_pci_dev->store)
- return edac_pci_dev->store(edac_pci_dev->value, buffer, count);
- return -EIO;
- }
- static const struct sysfs_ops edac_pci_sysfs_ops = {
- .show = edac_pci_dev_show,
- .store = edac_pci_dev_store
- };
- #define EDAC_PCI_ATTR(_name,_mode,_show,_store) \
- static struct edac_pci_dev_attribute edac_pci_attr_##_name = { \
- .attr = {.name = __stringify(_name), .mode = _mode }, \
- .value = &_name, \
- .show = _show, \
- .store = _store, \
- };
- #define EDAC_PCI_STRING_ATTR(_name,_data,_mode,_show,_store) \
- static struct edac_pci_dev_attribute edac_pci_attr_##_name = { \
- .attr = {.name = __stringify(_name), .mode = _mode }, \
- .value = _data, \
- .show = _show, \
- .store = _store, \
- };
- EDAC_PCI_ATTR(check_pci_errors, S_IRUGO | S_IWUSR, edac_pci_int_show,
- edac_pci_int_store);
- EDAC_PCI_ATTR(edac_pci_log_pe, S_IRUGO | S_IWUSR, edac_pci_int_show,
- edac_pci_int_store);
- EDAC_PCI_ATTR(edac_pci_log_npe, S_IRUGO | S_IWUSR, edac_pci_int_show,
- edac_pci_int_store);
- EDAC_PCI_ATTR(edac_pci_panic_on_pe, S_IRUGO | S_IWUSR, edac_pci_int_show,
- edac_pci_int_store);
- EDAC_PCI_ATTR(pci_parity_count, S_IRUGO, edac_pci_int_show, NULL);
- EDAC_PCI_ATTR(pci_nonparity_count, S_IRUGO, edac_pci_int_show, NULL);
- static struct edac_pci_dev_attribute *edac_pci_attr[] = {
- &edac_pci_attr_check_pci_errors,
- &edac_pci_attr_edac_pci_log_pe,
- &edac_pci_attr_edac_pci_log_npe,
- &edac_pci_attr_edac_pci_panic_on_pe,
- &edac_pci_attr_pci_parity_count,
- &edac_pci_attr_pci_nonparity_count,
- NULL,
- };
- static void edac_pci_release_main_kobj(struct kobject *kobj)
- {
- edac_dbg(0, "here to module_put(THIS_MODULE)\n");
- kfree(kobj);
-
- module_put(THIS_MODULE);
- }
- static struct kobj_type ktype_edac_pci_main_kobj = {
- .release = edac_pci_release_main_kobj,
- .sysfs_ops = &edac_pci_sysfs_ops,
- .default_attrs = (struct attribute **)edac_pci_attr,
- };
- static int edac_pci_main_kobj_setup(void)
- {
- int err;
- struct bus_type *edac_subsys;
- edac_dbg(0, "\n");
-
- if (atomic_inc_return(&edac_pci_sysfs_refcount) != 1)
- return 0;
-
- edac_subsys = edac_get_sysfs_subsys();
-
- if (!try_module_get(THIS_MODULE)) {
- edac_dbg(1, "try_module_get() failed\n");
- err = -ENODEV;
- goto decrement_count_fail;
- }
- edac_pci_top_main_kobj = kzalloc(sizeof(struct kobject), GFP_KERNEL);
- if (!edac_pci_top_main_kobj) {
- edac_dbg(1, "Failed to allocate\n");
- err = -ENOMEM;
- goto kzalloc_fail;
- }
-
- err = kobject_init_and_add(edac_pci_top_main_kobj,
- &ktype_edac_pci_main_kobj,
- &edac_subsys->dev_root->kobj, "pci");
- if (err) {
- edac_dbg(1, "Failed to register '.../edac/pci'\n");
- goto kobject_init_and_add_fail;
- }
-
- kobject_uevent(edac_pci_top_main_kobj, KOBJ_ADD);
- edac_dbg(1, "Registered '.../edac/pci' kobject\n");
- return 0;
-
- kobject_init_and_add_fail:
- kfree(edac_pci_top_main_kobj);
- kzalloc_fail:
- module_put(THIS_MODULE);
- decrement_count_fail:
-
- atomic_dec(&edac_pci_sysfs_refcount);
- return err;
- }
- static void edac_pci_main_kobj_teardown(void)
- {
- edac_dbg(0, "\n");
-
- if (atomic_dec_return(&edac_pci_sysfs_refcount) == 0) {
- edac_dbg(0, "called kobject_put on main kobj\n");
- kobject_put(edac_pci_top_main_kobj);
- }
- }
- int edac_pci_create_sysfs(struct edac_pci_ctl_info *pci)
- {
- int err;
- struct kobject *edac_kobj = &pci->kobj;
- edac_dbg(0, "idx=%d\n", pci->pci_idx);
-
- err = edac_pci_main_kobj_setup();
- if (err)
- return err;
-
- err = edac_pci_create_instance_kobj(pci, pci->pci_idx);
- if (err)
- goto unregister_cleanup;
- err = sysfs_create_link(edac_kobj, &pci->dev->kobj, EDAC_PCI_SYMLINK);
- if (err) {
- edac_dbg(0, "sysfs_create_link() returned err= %d\n", err);
- goto symlink_fail;
- }
- return 0;
-
- symlink_fail:
- edac_pci_unregister_sysfs_instance_kobj(pci);
- unregister_cleanup:
- edac_pci_main_kobj_teardown();
- return err;
- }
- void edac_pci_remove_sysfs(struct edac_pci_ctl_info *pci)
- {
- edac_dbg(0, "index=%d\n", pci->pci_idx);
-
- sysfs_remove_link(&pci->kobj, EDAC_PCI_SYMLINK);
-
- edac_pci_unregister_sysfs_instance_kobj(pci);
-
- edac_dbg(0, "calling edac_pci_main_kobj_teardown()\n");
- edac_pci_main_kobj_teardown();
- }
- static u16 get_pci_parity_status(struct pci_dev *dev, int secondary)
- {
- int where;
- u16 status;
- where = secondary ? PCI_SEC_STATUS : PCI_STATUS;
- pci_read_config_word(dev, where, &status);
-
- if (status == 0xFFFF) {
- u32 sanity;
- pci_read_config_dword(dev, 0, &sanity);
- if (sanity == 0xFFFFFFFF)
- return 0;
- }
- status &= PCI_STATUS_DETECTED_PARITY | PCI_STATUS_SIG_SYSTEM_ERROR |
- PCI_STATUS_PARITY;
- if (status)
-
- pci_write_config_word(dev, where, status);
- return status;
- }
- static void edac_pci_dev_parity_clear(struct pci_dev *dev)
- {
- u8 header_type;
- get_pci_parity_status(dev, 0);
-
- pci_read_config_byte(dev, PCI_HEADER_TYPE, &header_type);
- if ((header_type & 0x7F) == PCI_HEADER_TYPE_BRIDGE)
- get_pci_parity_status(dev, 1);
- }
- static void edac_pci_dev_parity_test(struct pci_dev *dev)
- {
- unsigned long flags;
- u16 status;
- u8 header_type;
-
- local_irq_save(flags);
-
- status = get_pci_parity_status(dev, 0);
-
- pci_read_config_byte(dev, PCI_HEADER_TYPE, &header_type);
- local_irq_restore(flags);
- edac_dbg(4, "PCI STATUS= 0x%04x %s\n", status, dev_name(&dev->dev));
-
- if (status && !dev->broken_parity_status) {
- if (status & (PCI_STATUS_SIG_SYSTEM_ERROR)) {
- edac_printk(KERN_CRIT, EDAC_PCI,
- "Signaled System Error on %s\n",
- pci_name(dev));
- atomic_inc(&pci_nonparity_count);
- }
- if (status & (PCI_STATUS_PARITY)) {
- edac_printk(KERN_CRIT, EDAC_PCI,
- "Master Data Parity Error on %s\n",
- pci_name(dev));
- atomic_inc(&pci_parity_count);
- }
- if (status & (PCI_STATUS_DETECTED_PARITY)) {
- edac_printk(KERN_CRIT, EDAC_PCI,
- "Detected Parity Error on %s\n",
- pci_name(dev));
- atomic_inc(&pci_parity_count);
- }
- }
- edac_dbg(4, "PCI HEADER TYPE= 0x%02x %s\n",
- header_type, dev_name(&dev->dev));
- if ((header_type & 0x7F) == PCI_HEADER_TYPE_BRIDGE) {
-
- status = get_pci_parity_status(dev, 1);
- edac_dbg(4, "PCI SEC_STATUS= 0x%04x %s\n",
- status, dev_name(&dev->dev));
-
- if (status && !dev->broken_parity_status) {
- if (status & (PCI_STATUS_SIG_SYSTEM_ERROR)) {
- edac_printk(KERN_CRIT, EDAC_PCI, "Bridge "
- "Signaled System Error on %s\n",
- pci_name(dev));
- atomic_inc(&pci_nonparity_count);
- }
- if (status & (PCI_STATUS_PARITY)) {
- edac_printk(KERN_CRIT, EDAC_PCI, "Bridge "
- "Master Data Parity Error on "
- "%s\n", pci_name(dev));
- atomic_inc(&pci_parity_count);
- }
- if (status & (PCI_STATUS_DETECTED_PARITY)) {
- edac_printk(KERN_CRIT, EDAC_PCI, "Bridge "
- "Detected Parity Error on %s\n",
- pci_name(dev));
- atomic_inc(&pci_parity_count);
- }
- }
- }
- }
- typedef void (*pci_parity_check_fn_t) (struct pci_dev *dev);
- static inline void edac_pci_dev_parity_iterator(pci_parity_check_fn_t fn)
- {
- struct pci_dev *dev = NULL;
- for_each_pci_dev(dev)
- fn(dev);
- }
- void edac_pci_do_parity_check(void)
- {
- int before_count;
- edac_dbg(3, "\n");
-
- if (!check_pci_errors)
- return;
- before_count = atomic_read(&pci_parity_count);
-
- edac_pci_dev_parity_iterator(edac_pci_dev_parity_test);
-
- if (edac_pci_get_panic_on_pe()) {
-
- if (before_count != atomic_read(&pci_parity_count))
- panic("EDAC: PCI Parity Error");
- }
- }
- void edac_pci_clear_parity_errors(void)
- {
-
- edac_pci_dev_parity_iterator(edac_pci_dev_parity_clear);
- }
- void edac_pci_handle_pe(struct edac_pci_ctl_info *pci, const char *msg)
- {
-
- atomic_inc(&pci->counters.pe_count);
- if (edac_pci_get_log_pe())
- edac_pci_printk(pci, KERN_WARNING,
- "Parity Error ctl: %s %d: %s\n",
- pci->ctl_name, pci->pci_idx, msg);
-
- edac_pci_do_parity_check();
- }
- EXPORT_SYMBOL_GPL(edac_pci_handle_pe);
- void edac_pci_handle_npe(struct edac_pci_ctl_info *pci, const char *msg)
- {
-
- atomic_inc(&pci->counters.npe_count);
- if (edac_pci_get_log_npe())
- edac_pci_printk(pci, KERN_WARNING,
- "Non-Parity Error ctl: %s %d: %s\n",
- pci->ctl_name, pci->pci_idx, msg);
-
- edac_pci_do_parity_check();
- }
- EXPORT_SYMBOL_GPL(edac_pci_handle_npe);
- module_param(check_pci_errors, int, 0644);
- MODULE_PARM_DESC(check_pci_errors,
- "Check for PCI bus parity errors: 0=off 1=on");
- module_param(edac_pci_panic_on_pe, int, 0644);
- MODULE_PARM_DESC(edac_pci_panic_on_pe,
- "Panic on PCI Bus Parity error: 0=off 1=on");
|