123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373 |
- /* irq.c
- * Parse IRQ-related files.
- */
- #include <stdlib.h>
- #include <stdio.h>
- #include <string.h>
- #include <sys/types.h>
- #include <dirent.h>
- #include <limits.h>
- #include <ctype.h>
- #include "lub/list.h"
- #include "irq.h"
- #include "pxm.h"
- #define STR(str) ( str ? str : "" )
- int irq_list_compare(const void *first, const void *second)
- {
- const irq_t *f = (const irq_t *)first;
- const irq_t *s = (const irq_t *)second;
- return (f->irq - s->irq);
- }
- static irq_t * irq_new(int num)
- {
- irq_t *new;
- if (!(new = malloc(sizeof(*new))))
- return NULL;
- new->irq = num;
- new->type = NULL;
- new->desc = NULL;
- new->refresh = 1;
- new->old_intr = 0;
- new->intr = 0;
- new->cpu = NULL;
- new->weight = 0;
- cpus_init(new->local_cpus);
- cpus_init(new->affinity);
- cpus_setall(new->local_cpus);
- cpus_clear(new->affinity);
- new->blacklisted = 0;
- return new;
- }
- static void irq_free(irq_t *irq)
- {
- free(irq->type);
- free(irq->desc);
- cpus_free(irq->local_cpus);
- cpus_free(irq->affinity);
- free(irq);
- }
- irq_t * irq_list_search(lub_list_t *irqs, unsigned int num)
- {
- lub_list_node_t *node;
- irq_t search;
- search.irq = num;
- node = lub_list_search(irqs, &search);
- if (!node)
- return NULL;
- return (irq_t *)lub_list_node__get_data(node);
- }
- static irq_t * irq_list_add(lub_list_t *irqs, unsigned int num)
- {
- lub_list_node_t *node;
- irq_t *new;
- irq_t search;
- search.irq = num;
- node = lub_list_search(irqs, &search);
- if (node) /* IRQ already exists. May be renew some fields later */
- return (irq_t *)lub_list_node__get_data(node);
- if (!(new = irq_new(num)))
- return NULL;
- lub_list_add(irqs, new);
- return new;
- }
- int irq_list_free(lub_list_t *irqs)
- {
- lub_list_node_t *iter;
- while ((iter = lub_list__get_head(irqs))) {
- irq_t *irq;
- irq = (irq_t *)lub_list_node__get_data(iter);
- irq_free(irq);
- lub_list_del(irqs, iter);
- lub_list_node_free(iter);
- }
- lub_list_free(irqs);
- return 0;
- }
- /* Show IRQ information */
- static void irq_show(irq_t *irq)
- {
- char buf[NR_CPUS + 1];
- char buf2[NR_CPUS + 1];
- if (cpus_full(irq->local_cpus))
- snprintf(buf, sizeof(buf), "*");
- else
- cpumask_scnprintf(buf, sizeof(buf), irq->local_cpus);
- buf[sizeof(buf) - 1] = '\0';
- cpumask_scnprintf(buf2, sizeof(buf2), irq->affinity);
- buf2[sizeof(buf2) - 1] = '\0';
- printf("IRQ %3d [%s] [%s] [%s] %s %llu %llu\n", irq->irq, buf, buf2, STR(irq->type), STR(irq->desc), irq->old_intr, irq->intr);
- }
- /* Show IRQ list */
- int irq_list_show(lub_list_t *irqs)
- {
- lub_list_node_t *iter;
- for (iter = lub_list_iterator_init(irqs); iter;
- iter = lub_list_iterator_next(iter)) {
- irq_t *irq;
- irq = (irq_t *)lub_list_node__get_data(iter);
- irq_show(irq);
- }
- return 0;
- }
- static int parse_local_cpus(lub_list_t *irqs, const char *sysfs_path,
- unsigned int num, lub_list_t *pxms)
- {
- char path[PATH_MAX];
- FILE *fd = NULL;
- char *str = NULL;
- size_t sz;
- cpumask_t local_cpus;
- irq_t *irq = NULL;
- cpumask_t cpumask;
- int ret = -1;
- irq = irq_list_search(irqs, num);
- if (!irq)
- return ret;
- cpus_init(local_cpus);
- cpus_init(cpumask);
- /* Find proximity in config file. */
- if (!pxm_search(pxms, sysfs_path, &cpumask)) {
- cpus_copy(irq->local_cpus, cpumask);
- ret = 0; /* success */
- goto error;
- }
- snprintf(path, sizeof(path),
- "%s/%s/local_cpus", SYSFS_PCI_PATH, sysfs_path);
- path[sizeof(path) - 1] = '\0';
- if (!(fd = fopen(path, "r")))
- goto error;
- if (getline(&str, &sz, fd) < 0)
- goto error;
- cpumask_parse_user(str, strlen(str), local_cpus);
- cpus_and(irq->local_cpus, irq->local_cpus, local_cpus);
- ret = 0; /* success */
- error:
- if (fd)
- fclose(fd);
- if (str)
- free(str);
- cpus_free(local_cpus);
- cpus_free(cpumask);
- return ret;
- }
- static int parse_sysfs(lub_list_t *irqs, lub_list_t *pxms)
- {
- DIR *dir;
- DIR *msi;
- struct dirent *dent;
- struct dirent *ment;
- FILE *fd;
- char path[PATH_MAX];
- int num;
- /* Now we can parse PCI devices only */
- /* Get info from /sys/bus/pci/devices */
- dir = opendir(SYSFS_PCI_PATH);
- if (!dir)
- return -1;
- while((dent = readdir(dir))) {
- if (!strcmp(dent->d_name, ".") ||
- !strcmp(dent->d_name, ".."))
- continue;
- /* Search for MSI IRQs. Since linux-3.2 */
- snprintf(path, sizeof(path),
- "%s/%s/msi_irqs", SYSFS_PCI_PATH, dent->d_name);
- path[sizeof(path) - 1] = '\0';
- if ((msi = opendir(path))) {
- while((ment = readdir(msi))) {
- if (!strcmp(ment->d_name, ".") ||
- !strcmp(ment->d_name, ".."))
- continue;
- num = strtol(ment->d_name, NULL, 10);
- if (!num)
- continue;
- parse_local_cpus(irqs, dent->d_name, num, pxms);
- }
- closedir(msi);
- continue;
- }
- /* Try to get IRQ number from irq file */
- snprintf(path, sizeof(path),
- "%s/%s/irq", SYSFS_PCI_PATH, dent->d_name);
- path[sizeof(path) - 1] = '\0';
- if (!(fd = fopen(path, "r")))
- continue;
- if (fscanf(fd, "%d", &num) < 0) {
- fclose(fd);
- continue;
- }
- fclose(fd);
- if (!num)
- continue;
- parse_local_cpus(irqs, dent->d_name, num, pxms);
- }
- closedir(dir);
- return 0;
- }
- int irq_get_affinity(irq_t *irq)
- {
- char path[PATH_MAX];
- FILE *fd;
- char *str = NULL;
- size_t sz;
- if (!irq)
- return -1;
- snprintf(path, sizeof(path),
- "%s/%u/smp_affinity", PROC_IRQ, irq->irq);
- path[sizeof(path) - 1] = '\0';
- if (!(fd = fopen(path, "r")))
- return -1;
- if (getline(&str, &sz, fd) < 0) {
- fclose(fd);
- return -1;
- }
- fclose(fd);
- cpumask_parse_user(str, strlen(str), irq->affinity);
- free(str);
- return 0;
- }
- /* Parse /proc/interrupts to get actual IRQ list */
- int scan_irqs(lub_list_t *irqs, lub_list_t *balance_irqs, lub_list_t *pxms)
- {
- FILE *fd;
- unsigned int num;
- char *str = NULL;
- size_t sz;
- irq_t *irq;
- lub_list_node_t *iter;
- int new_irq_num = 0;
- if (!(fd = fopen(PROC_INTERRUPTS, "r")))
- return -1;
- while(getline(&str, &sz, fd) >= 0) {
- char *endptr, *tok;
- int new = 0;
- num = strtoul(str, &endptr, 10);
- if (endptr == str)
- continue;
- /* Search for IRQ within list of known IRQs */
- if (!(irq = irq_list_search(irqs, num))) {
- new = 1;
- new_irq_num++;
- irq = irq_list_add(irqs, num);
- /* By default all CPUs are local for IRQ. Real local
- * CPUs will be find while sysfs scan.
- */
- cpus_setall(irq->local_cpus);
- }
- /* Set refresh flag because IRQ was found.
- * It's used to find out disappeared IRQs.
- */
- irq->refresh = 1;
- /* Doesn't refresh info for blacklisted IRQs */
- if (irq->blacklisted)
- continue;
-
- /* Find IRQ type - first non-digital and non-space */
- while (*endptr && !isalpha(*endptr))
- endptr++;
- tok = endptr; /* It will be IRQ type */
- while (*endptr && !isblank(*endptr))
- endptr++;
- free(irq->type);
- irq->type = strndup(tok, endptr - tok);
- /* Find IRQ devices list */
- while (*endptr && !isalpha(*endptr))
- endptr++;
- tok = endptr; /* It will be device list */
- while (*endptr && !iscntrl(*endptr))
- endptr++;
- free(irq->desc);
- irq->desc = strndup(tok, endptr - tok);
- /* Always get current smp affinity. It's necessary due to
- * problems with arch/driver. The affinity can be old (didn't
- * switched to new state).
- */
- irq_get_affinity(irq);
- /* Print info about new IRQ. */
- if (new)
- printf("Add IRQ %3d %s\n", irq->irq, STR(irq->desc));
- /* If affinity uses more than one CPU then consider IRQ as new one.
- * It's not normal state for really non-new IRQs.
- */
- if (cpus_weight(irq->affinity) <= 1)
- continue;
- /* Don't balance IRQs with 0 number of interrupts */
- if (irq->intr == 0)
- continue;
- /* Add IRQs to list of IRQs to balance. */
- lub_list_add(balance_irqs, irq);
- }
- free(str);
- fclose(fd);
- /* Remove disappeared IRQs */
- iter = lub_list_iterator_init(irqs);
- while(iter) {
- irq_t *irq;
- lub_list_node_t *old_iter;
- irq = (irq_t *)lub_list_node__get_data(iter);
- old_iter = iter;
- iter = lub_list_iterator_next(iter);
- if (!irq->refresh) {
- lub_list_del(irqs, old_iter);
- printf("Remove IRQ %3d %s\n", irq->irq, STR(irq->desc));
- irq_free(irq);
- } else {
- /* Drop refresh flag for next iteration */
- irq->refresh = 0;
- }
- }
- /* No new IRQs were found. It doesn't need to scan sysfs. */
- if (new_irq_num == 0)
- return 0;
- /* Add IRQ info from sysfs */
- printf("New IRQs: %d. Scanning sysfs...\n", new_irq_num);
- parse_sysfs(irqs, pxms);
- return 0;
- }
|