summaryrefslogtreecommitdiff
path: root/irq.c
blob: 2f7eafa07f6f60be5788dd3e16053c1875411d2d (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <stdbool.h>
#include <errno.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>

#include "irq.h"
#include "str.h"
#include "die.h"

int device_irq_number(const char *ifname)
{
	int irq = 0;
	char buff[128], sysname[128];
	FILE *fp;

	if (!strncmp("lo", ifname, strlen("lo")))
		return 0;

	slprintf(sysname, sizeof(sysname),
		 "/sys/class/net/%s/device/irq",
		 ifname);

	fp = fopen(sysname, "r");
	if (!fp)
		return -ENOENT;

	memset(buff, 0, sizeof(buff));

	if (fgets(buff, sizeof(buff), fp) != NULL) {
		buff[sizeof(buff) - 1] = 0;
		irq = atoi(buff);
	}

	fclose(fp);
	return irq;
}

static char nic_irq_affinity_list[128];
static bool nic_irq_stored = false;
static int  nic_irq = -1;

static void device_save_irq_affinity_list(void)
{
	int ret, fd;
	char file[128];

	bug_on(nic_irq_stored);

	slprintf(file, sizeof(file),
		 "/proc/irq/%d/smp_affinity_list", nic_irq);

	fd = open(file, O_RDONLY);
	if (fd < 0)
		return;

	memset(nic_irq_affinity_list, 0, sizeof(nic_irq_affinity_list));

	ret = read(fd, nic_irq_affinity_list,
		   sizeof(nic_irq_affinity_list));
	if (ret < 0)
		panic("Cannot store NIC IRQ affinity!\n");

	close(fd);

	nic_irq_stored = true;
}

void device_restore_irq_affinity_list(void)
{
	int ret, fd;
	char file[128];

	if (!nic_irq_stored)
		return;

	bug_on(nic_irq == -1);

	slprintf(file, sizeof(file),
		 "/proc/irq/%d/smp_affinity_list", nic_irq);

	fd = open(file, O_WRONLY);
	if (fd < 0)
		return;

	ret = write(fd, nic_irq_affinity_list,
		    sizeof(nic_irq_affinity_list));
	if (ret < 0)
		panic("Cannot restore NIC IRQ affinity!\n");

	close(fd);
}

int device_set_irq_affinity_list(int irq, unsigned long from, unsigned long to)
{
	int ret, fd;
	char file[128], list[64];

	if (unlikely(irq == 0))
		return 0;
	if (!nic_irq_stored) {
		nic_irq = irq;
		device_save_irq_affinity_list();
	}

	slprintf(file, sizeof(file), "/proc/irq/%d/smp_affinity_list", irq);
	slprintf(list, sizeof(list), "%lu-%lu\n", from, to);

	fd = open(file, O_WRONLY);
	if (fd < 0)
		return -ENOENT;

	ret = write(fd, list, strlen(list));

	close(fd);
	return ret;
}

int device_set_irq_affinity(int irq, unsigned long cpu)
{
	return device_set_irq_affinity_list(irq, cpu, cpu);
}