net/memif: fix Unix domain address length
[dpdk.git] / examples / vm_power_manager / channel_manager.c
1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(c) 2010-2014 Intel Corporation
3  */
4
5 #include <stdio.h>
6 #include <stdlib.h>
7 #include <sys/un.h>
8 #include <fcntl.h>
9 #include <unistd.h>
10 #include <inttypes.h>
11 #include <dirent.h>
12 #include <errno.h>
13
14 #include <sys/queue.h>
15 #include <sys/types.h>
16 #include <sys/stat.h>
17 #include <sys/socket.h>
18 #include <sys/select.h>
19
20 #include <rte_string_fns.h>
21 #include <rte_malloc.h>
22 #include <rte_memory.h>
23 #include <rte_mempool.h>
24 #include <rte_log.h>
25 #include <rte_atomic.h>
26 #include <rte_spinlock.h>
27
28 #include <libvirt/libvirt.h>
29
30 #include "channel_manager.h"
31 #include "channel_commands.h"
32 #include "channel_monitor.h"
33 #include "power_manager.h"
34
35
36 #define RTE_LOGTYPE_CHANNEL_MANAGER RTE_LOGTYPE_USER1
37
38 /* Global pointer to libvirt connection */
39 static virConnectPtr global_vir_conn_ptr;
40
41 static unsigned char *global_cpumaps;
42 static virVcpuInfo *global_vircpuinfo;
43 static size_t global_maplen;
44
45 static unsigned int global_n_host_cpus;
46 static bool global_hypervisor_available;
47
48 /*
49  * Represents a single Virtual Machine
50  */
51 struct virtual_machine_info {
52         char name[CHANNEL_MGR_MAX_NAME_LEN];
53         uint16_t pcpu_map[RTE_MAX_LCORE];
54         struct channel_info *channels[RTE_MAX_LCORE];
55         char channel_mask[RTE_MAX_LCORE];
56         uint8_t num_channels;
57         enum vm_status status;
58         virDomainPtr domainPtr;
59         virDomainInfo info;
60         rte_spinlock_t config_spinlock;
61         LIST_ENTRY(virtual_machine_info) vms_info;
62 };
63
64 LIST_HEAD(, virtual_machine_info) vm_list_head;
65
66 static struct virtual_machine_info *
67 find_domain_by_name(const char *name)
68 {
69         struct virtual_machine_info *info;
70         LIST_FOREACH(info, &vm_list_head, vms_info) {
71                 if (!strncmp(info->name, name, CHANNEL_MGR_MAX_NAME_LEN-1))
72                         return info;
73         }
74         return NULL;
75 }
76
77 static int
78 update_pcpus_mask(struct virtual_machine_info *vm_info)
79 {
80         virVcpuInfoPtr cpuinfo;
81         unsigned i, j;
82         int n_vcpus;
83
84         memset(global_cpumaps, 0, RTE_MAX_LCORE*global_maplen);
85
86         if (!virDomainIsActive(vm_info->domainPtr)) {
87                 n_vcpus = virDomainGetVcpuPinInfo(vm_info->domainPtr,
88                                 vm_info->info.nrVirtCpu, global_cpumaps, global_maplen,
89                                 VIR_DOMAIN_AFFECT_CONFIG);
90                 if (n_vcpus < 0) {
91                         RTE_LOG(ERR, CHANNEL_MANAGER, "Error getting vCPU info for "
92                                         "in-active VM '%s'\n", vm_info->name);
93                         return -1;
94                 }
95                 goto update_pcpus;
96         }
97
98         memset(global_vircpuinfo, 0, sizeof(*global_vircpuinfo)*
99                         RTE_MAX_LCORE);
100
101         cpuinfo = global_vircpuinfo;
102
103         n_vcpus = virDomainGetVcpus(vm_info->domainPtr, cpuinfo,
104                         RTE_MAX_LCORE, global_cpumaps, global_maplen);
105         if (n_vcpus < 0) {
106                 RTE_LOG(ERR, CHANNEL_MANAGER, "Error getting vCPU info for "
107                                 "active VM '%s'\n", vm_info->name);
108                 return -1;
109         }
110 update_pcpus:
111         if (n_vcpus >= RTE_MAX_LCORE) {
112                 RTE_LOG(ERR, CHANNEL_MANAGER, "Number of vCPUS(%u) is out of range "
113                                 "0...%d\n", n_vcpus, RTE_MAX_LCORE-1);
114                 return -1;
115         }
116         if (n_vcpus != vm_info->info.nrVirtCpu) {
117                 RTE_LOG(INFO, CHANNEL_MANAGER, "Updating the number of vCPUs for VM '%s"
118                                 " from %d -> %d\n", vm_info->name, vm_info->info.nrVirtCpu,
119                                 n_vcpus);
120                 vm_info->info.nrVirtCpu = n_vcpus;
121         }
122         rte_spinlock_lock(&(vm_info->config_spinlock));
123         for (i = 0; i < vm_info->info.nrVirtCpu; i++) {
124                 for (j = 0; j < global_n_host_cpus; j++) {
125                         if (VIR_CPU_USABLE(global_cpumaps,
126                                         global_maplen, i, j) <= 0)
127                                 continue;
128                         vm_info->pcpu_map[i] = j;
129                 }
130         }
131         rte_spinlock_unlock(&(vm_info->config_spinlock));
132         return 0;
133 }
134
135 int
136 set_pcpu(char *vm_name, unsigned int vcpu, unsigned int pcpu)
137 {
138         int flags = VIR_DOMAIN_AFFECT_LIVE|VIR_DOMAIN_AFFECT_CONFIG;
139         struct virtual_machine_info *vm_info;
140
141         if (vcpu >= RTE_MAX_LCORE) {
142                 RTE_LOG(ERR, CHANNEL_MANAGER, "vCPU(%u) exceeds max allowable(%d)\n",
143                                 vcpu, RTE_MAX_LCORE-1);
144                 return -1;
145         }
146
147         vm_info = find_domain_by_name(vm_name);
148         if (vm_info == NULL) {
149                 RTE_LOG(ERR, CHANNEL_MANAGER, "VM '%s' not found\n", vm_name);
150                 return -1;
151         }
152
153         if (!virDomainIsActive(vm_info->domainPtr)) {
154                 RTE_LOG(ERR, CHANNEL_MANAGER, "Unable to set vCPU(%u) to pCPU "
155                                 " for VM '%s', VM is not active\n",
156                                 vcpu, vm_info->name);
157                 return -1;
158         }
159
160         if (vcpu >= vm_info->info.nrVirtCpu) {
161                 RTE_LOG(ERR, CHANNEL_MANAGER, "vCPU(%u) exceeds the assigned number of "
162                                 "vCPUs(%u)\n", vcpu, vm_info->info.nrVirtCpu);
163                 return -1;
164         }
165         memset(global_cpumaps, 0, RTE_MAX_LCORE * global_maplen);
166
167         VIR_USE_CPU(global_cpumaps, pcpu);
168
169         if (pcpu >= global_n_host_cpus) {
170                 RTE_LOG(ERR, CHANNEL_MANAGER, "CPU(%u) exceeds the available "
171                                 "number of CPUs(%u)\n",
172                                 pcpu, global_n_host_cpus);
173                 return -1;
174         }
175
176         if (virDomainPinVcpuFlags(vm_info->domainPtr, vcpu, global_cpumaps,
177                         global_maplen, flags) < 0) {
178                 RTE_LOG(ERR, CHANNEL_MANAGER, "Unable to set vCPU(%u) to pCPU "
179                                 " for VM '%s'\n", vcpu,
180                                 vm_info->name);
181                 return -1;
182         }
183         rte_spinlock_lock(&(vm_info->config_spinlock));
184         vm_info->pcpu_map[vcpu] = pcpu;
185         rte_spinlock_unlock(&(vm_info->config_spinlock));
186         return 0;
187 }
188
189 uint16_t
190 get_pcpu(struct channel_info *chan_info, unsigned int vcpu)
191 {
192         struct virtual_machine_info *vm_info =
193                         (struct virtual_machine_info *)chan_info->priv_info;
194
195         if (global_hypervisor_available && (vm_info != NULL)) {
196                 uint16_t pcpu;
197                 rte_spinlock_lock(&(vm_info->config_spinlock));
198                 pcpu = vm_info->pcpu_map[vcpu];
199                 rte_spinlock_unlock(&(vm_info->config_spinlock));
200                 return pcpu;
201         } else
202                 return 0;
203 }
204
205 static inline int
206 channel_exists(struct virtual_machine_info *vm_info, unsigned channel_num)
207 {
208         rte_spinlock_lock(&(vm_info->config_spinlock));
209         if (vm_info->channel_mask[channel_num] == 1) {
210                 rte_spinlock_unlock(&(vm_info->config_spinlock));
211                 return 1;
212         }
213         rte_spinlock_unlock(&(vm_info->config_spinlock));
214         return 0;
215 }
216
217
218
219 static int
220 open_non_blocking_channel(struct channel_info *info)
221 {
222         int ret, flags;
223         struct sockaddr_un sock_addr;
224         fd_set soc_fd_set;
225         struct timeval tv;
226
227         info->fd = socket(AF_UNIX, SOCK_STREAM, 0);
228         if (info->fd < 0) {
229                 RTE_LOG(ERR, CHANNEL_MANAGER, "Error(%s) creating socket for '%s'\n",
230                                 strerror(errno),
231                                 info->channel_path);
232                 return -1;
233         }
234         sock_addr.sun_family = AF_UNIX;
235         memcpy(&sock_addr.sun_path, info->channel_path,
236                         strlen(info->channel_path)+1);
237
238         /* Get current flags */
239         flags = fcntl(info->fd, F_GETFL, 0);
240         if (flags < 0) {
241                 RTE_LOG(WARNING, CHANNEL_MANAGER, "Error(%s) fcntl get flags socket for"
242                                 "'%s'\n", strerror(errno), info->channel_path);
243                 return 1;
244         }
245         /* Set to Non Blocking */
246         flags |= O_NONBLOCK;
247         if (fcntl(info->fd, F_SETFL, flags) < 0) {
248                 RTE_LOG(WARNING, CHANNEL_MANAGER, "Error(%s) setting non-blocking "
249                                 "socket for '%s'\n", strerror(errno), info->channel_path);
250                 return -1;
251         }
252         ret = connect(info->fd, (struct sockaddr *)&sock_addr,
253                         sizeof(sock_addr));
254         if (ret < 0) {
255                 /* ECONNREFUSED error is given when VM is not active */
256                 if (errno == ECONNREFUSED) {
257                         RTE_LOG(WARNING, CHANNEL_MANAGER, "VM is not active or has not "
258                                         "activated its endpoint to channel %s\n",
259                                         info->channel_path);
260                         return -1;
261                 }
262                 /* Wait for tv_sec if in progress */
263                 else if (errno == EINPROGRESS) {
264                         tv.tv_sec = 2;
265                         tv.tv_usec = 0;
266                         FD_ZERO(&soc_fd_set);
267                         FD_SET(info->fd, &soc_fd_set);
268                         if (select(info->fd+1, NULL, &soc_fd_set, NULL, &tv) > 0) {
269                                 RTE_LOG(WARNING, CHANNEL_MANAGER, "Timeout or error on channel "
270                                                 "'%s'\n", info->channel_path);
271                                 return -1;
272                         }
273                 } else {
274                         /* Any other error */
275                         RTE_LOG(WARNING, CHANNEL_MANAGER, "Error(%s) connecting socket"
276                                         " for '%s'\n", strerror(errno), info->channel_path);
277                         return -1;
278                 }
279         }
280         return 0;
281 }
282
283 static int
284 open_host_channel(struct channel_info *info)
285 {
286         int flags;
287
288         info->fd = open(info->channel_path, O_RDWR | O_RSYNC);
289         if (info->fd < 0) {
290                 RTE_LOG(ERR, CHANNEL_MANAGER, "Error(%s) opening fifo for '%s'\n",
291                                 strerror(errno),
292                                 info->channel_path);
293                 return -1;
294         }
295
296         /* Get current flags */
297         flags = fcntl(info->fd, F_GETFL, 0);
298         if (flags < 0) {
299                 RTE_LOG(WARNING, CHANNEL_MANAGER, "Error(%s) fcntl get flags socket for"
300                                 "'%s'\n", strerror(errno), info->channel_path);
301                 return 1;
302         }
303         /* Set to Non Blocking */
304         flags |= O_NONBLOCK;
305         if (fcntl(info->fd, F_SETFL, flags) < 0) {
306                 RTE_LOG(WARNING, CHANNEL_MANAGER,
307                                 "Error(%s) setting non-blocking "
308                                 "socket for '%s'\n",
309                                 strerror(errno), info->channel_path);
310                 return -1;
311         }
312         return 0;
313 }
314
315 static int
316 setup_channel_info(struct virtual_machine_info **vm_info_dptr,
317                 struct channel_info **chan_info_dptr, unsigned channel_num)
318 {
319         struct channel_info *chan_info = *chan_info_dptr;
320         struct virtual_machine_info *vm_info = *vm_info_dptr;
321
322         chan_info->channel_num = channel_num;
323         chan_info->priv_info = (void *)vm_info;
324         chan_info->status = CHANNEL_MGR_CHANNEL_DISCONNECTED;
325         chan_info->type = CHANNEL_TYPE_BINARY;
326         if (open_non_blocking_channel(chan_info) < 0) {
327                 RTE_LOG(ERR, CHANNEL_MANAGER, "Could not open channel: "
328                                 "'%s' for VM '%s'\n",
329                                 chan_info->channel_path, vm_info->name);
330                 return -1;
331         }
332         if (add_channel_to_monitor(&chan_info) < 0) {
333                 RTE_LOG(ERR, CHANNEL_MANAGER, "Could add channel: "
334                                 "'%s' to epoll ctl for VM '%s'\n",
335                                 chan_info->channel_path, vm_info->name);
336                 return -1;
337
338         }
339         rte_spinlock_lock(&(vm_info->config_spinlock));
340         vm_info->num_channels++;
341         vm_info->channel_mask[channel_num] = 1;
342         vm_info->channels[channel_num] = chan_info;
343         chan_info->status = CHANNEL_MGR_CHANNEL_CONNECTED;
344         rte_spinlock_unlock(&(vm_info->config_spinlock));
345         return 0;
346 }
347
348 static int
349 fifo_path(char *dst, unsigned int len, unsigned int id)
350 {
351         int cnt;
352
353         cnt = snprintf(dst, len, "%s%s%d", CHANNEL_MGR_SOCKET_PATH,
354                         CHANNEL_MGR_FIFO_PATTERN_NAME, id);
355
356         if ((cnt < 0) || (cnt > (int)len - 1)) {
357                 RTE_LOG(ERR, CHANNEL_MANAGER, "Could not create proper "
358                         "string for fifo path\n");
359
360                 return -1;
361         }
362
363         return 0;
364 }
365
366 static int
367 setup_host_channel_info(struct channel_info **chan_info_dptr,
368                 unsigned int channel_num)
369 {
370         struct channel_info *chan_info = *chan_info_dptr;
371
372         chan_info->channel_num = channel_num;
373         chan_info->priv_info = (void *)NULL;
374         chan_info->status = CHANNEL_MGR_CHANNEL_DISCONNECTED;
375         chan_info->type = CHANNEL_TYPE_JSON;
376
377         if (open_host_channel(chan_info) < 0) {
378                 RTE_LOG(ERR, CHANNEL_MANAGER, "Could not open host channel: "
379                                 "'%s'\n",
380                                 chan_info->channel_path);
381                 return -1;
382         }
383         if (add_channel_to_monitor(&chan_info) < 0) {
384                 RTE_LOG(ERR, CHANNEL_MANAGER, "Could add channel: "
385                                 "'%s' to epoll ctl\n",
386                                 chan_info->channel_path);
387                 return -1;
388
389         }
390         chan_info->status = CHANNEL_MGR_CHANNEL_CONNECTED;
391         return 0;
392 }
393
394 int
395 add_all_channels(const char *vm_name)
396 {
397         DIR *d;
398         struct dirent *dir;
399         struct virtual_machine_info *vm_info;
400         struct channel_info *chan_info;
401         char *token, *remaining, *tail_ptr;
402         char socket_name[PATH_MAX];
403         unsigned channel_num;
404         int num_channels_enabled = 0;
405
406         /* verify VM exists */
407         vm_info = find_domain_by_name(vm_name);
408         if (vm_info == NULL) {
409                 RTE_LOG(ERR, CHANNEL_MANAGER, "VM: '%s' not found"
410                                 " during channel discovery\n", vm_name);
411                 return 0;
412         }
413         if (!virDomainIsActive(vm_info->domainPtr)) {
414                 RTE_LOG(ERR, CHANNEL_MANAGER, "VM: '%s' is not active\n", vm_name);
415                 vm_info->status = CHANNEL_MGR_VM_INACTIVE;
416                 return 0;
417         }
418         d = opendir(CHANNEL_MGR_SOCKET_PATH);
419         if (d == NULL) {
420                 RTE_LOG(ERR, CHANNEL_MANAGER, "Error opening directory '%s': %s\n",
421                                 CHANNEL_MGR_SOCKET_PATH, strerror(errno));
422                 return -1;
423         }
424         while ((dir = readdir(d)) != NULL) {
425                 if (!strncmp(dir->d_name, ".", 1) ||
426                                 !strncmp(dir->d_name, "..", 2))
427                         continue;
428
429                 strlcpy(socket_name, dir->d_name, sizeof(socket_name));
430                 remaining = socket_name;
431                 /* Extract vm_name from "<vm_name>.<channel_num>" */
432                 token = strsep(&remaining, ".");
433                 if (remaining == NULL)
434                         continue;
435                 if (strncmp(vm_name, token, CHANNEL_MGR_MAX_NAME_LEN))
436                         continue;
437
438                 /* remaining should contain only <channel_num> */
439                 errno = 0;
440                 channel_num = (unsigned)strtol(remaining, &tail_ptr, 0);
441                 if ((errno != 0) || (remaining[0] == '\0') ||
442                                 tail_ptr == NULL || (*tail_ptr != '\0')) {
443                         RTE_LOG(WARNING, CHANNEL_MANAGER, "Malformed channel name"
444                                         "'%s' found it should be in the form of "
445                                         "'<guest_name>.<channel_num>(decimal)'\n",
446                                         dir->d_name);
447                         continue;
448                 }
449                 if (channel_num >= RTE_MAX_LCORE) {
450                         RTE_LOG(WARNING, CHANNEL_MANAGER, "Channel number(%u) is "
451                                         "greater than max allowable: %d, skipping '%s%s'\n",
452                                         channel_num, RTE_MAX_LCORE-1,
453                                         CHANNEL_MGR_SOCKET_PATH, dir->d_name);
454                         continue;
455                 }
456                 /* if channel has not been added previously */
457                 if (channel_exists(vm_info, channel_num))
458                         continue;
459
460                 chan_info = rte_malloc(NULL, sizeof(*chan_info),
461                                 RTE_CACHE_LINE_SIZE);
462                 if (chan_info == NULL) {
463                         RTE_LOG(ERR, CHANNEL_MANAGER, "Error allocating memory for "
464                                 "channel '%s%s'\n", CHANNEL_MGR_SOCKET_PATH, dir->d_name);
465                         continue;
466                 }
467
468                 snprintf(chan_info->channel_path,
469                                 sizeof(chan_info->channel_path), "%s%s",
470                                 CHANNEL_MGR_SOCKET_PATH, dir->d_name);
471
472                 if (setup_channel_info(&vm_info, &chan_info, channel_num) < 0) {
473                         rte_free(chan_info);
474                         continue;
475                 }
476
477                 num_channels_enabled++;
478         }
479         closedir(d);
480         return num_channels_enabled;
481 }
482
483 int
484 add_channels(const char *vm_name, unsigned *channel_list,
485                 unsigned len_channel_list)
486 {
487         struct virtual_machine_info *vm_info;
488         struct channel_info *chan_info;
489         char socket_path[PATH_MAX];
490         unsigned i;
491         int num_channels_enabled = 0;
492
493         vm_info = find_domain_by_name(vm_name);
494         if (vm_info == NULL) {
495                 RTE_LOG(ERR, CHANNEL_MANAGER, "Unable to add channels: VM '%s' "
496                                 "not found\n", vm_name);
497                 return 0;
498         }
499
500         if (!virDomainIsActive(vm_info->domainPtr)) {
501                 RTE_LOG(ERR, CHANNEL_MANAGER, "VM: '%s' is not active\n", vm_name);
502                 vm_info->status = CHANNEL_MGR_VM_INACTIVE;
503                 return 0;
504         }
505
506         for (i = 0; i < len_channel_list; i++) {
507
508                 if (channel_list[i] >= RTE_MAX_LCORE) {
509                         RTE_LOG(INFO, CHANNEL_MANAGER, "Channel(%u) is out of range "
510                                                         "0...%d\n", channel_list[i],
511                                                         RTE_MAX_LCORE-1);
512                         continue;
513                 }
514                 if (channel_exists(vm_info, channel_list[i])) {
515                         RTE_LOG(INFO, CHANNEL_MANAGER, "Channel already exists, skipping  "
516                                         "'%s.%u'\n", vm_name, i);
517                         continue;
518                 }
519
520                 snprintf(socket_path, sizeof(socket_path), "%s%s.%u",
521                                 CHANNEL_MGR_SOCKET_PATH, vm_name, channel_list[i]);
522                 errno = 0;
523                 if (access(socket_path, F_OK) < 0) {
524                         RTE_LOG(ERR, CHANNEL_MANAGER, "Channel path '%s' error: "
525                                         "%s\n", socket_path, strerror(errno));
526                         continue;
527                 }
528                 chan_info = rte_malloc(NULL, sizeof(*chan_info),
529                                 RTE_CACHE_LINE_SIZE);
530                 if (chan_info == NULL) {
531                         RTE_LOG(ERR, CHANNEL_MANAGER, "Error allocating memory for "
532                                         "channel '%s'\n", socket_path);
533                         continue;
534                 }
535                 snprintf(chan_info->channel_path,
536                                 sizeof(chan_info->channel_path), "%s%s.%u",
537                                 CHANNEL_MGR_SOCKET_PATH, vm_name, channel_list[i]);
538                 if (setup_channel_info(&vm_info, &chan_info, channel_list[i]) < 0) {
539                         rte_free(chan_info);
540                         continue;
541                 }
542                 num_channels_enabled++;
543
544         }
545         return num_channels_enabled;
546 }
547
548 int
549 add_host_channels(void)
550 {
551         struct channel_info *chan_info;
552         char socket_path[PATH_MAX];
553         int num_channels_enabled = 0;
554         int ret;
555         struct core_info *ci;
556         struct channel_info *chan_infos[RTE_MAX_LCORE];
557         int i;
558
559         for (i = 0; i < RTE_MAX_LCORE; i++)
560                 chan_infos[i] = NULL;
561
562         ci = get_core_info();
563         if (ci == NULL) {
564                 RTE_LOG(ERR, CHANNEL_MANAGER, "Cannot allocate memory for core_info\n");
565                 return 0;
566         }
567
568         for (i = 0; i < ci->core_count; i++) {
569                 if (ci->cd[i].global_enabled_cpus == 0)
570                         continue;
571
572                 ret = fifo_path(socket_path, sizeof(socket_path), i);
573                 if (ret < 0)
574                         goto error;
575
576                 ret = mkfifo(socket_path, 0660);
577                 RTE_LOG(DEBUG, CHANNEL_MANAGER, "TRY CREATE fifo '%s'\n",
578                         socket_path);
579                 if ((errno != EEXIST) && (ret < 0)) {
580                         RTE_LOG(ERR, CHANNEL_MANAGER, "Cannot create fifo '%s' error: "
581                                         "%s\n", socket_path, strerror(errno));
582                         goto error;
583                 }
584                 chan_info = rte_malloc(NULL, sizeof(*chan_info), 0);
585                 if (chan_info == NULL) {
586                         RTE_LOG(ERR, CHANNEL_MANAGER, "Error allocating memory for "
587                                         "channel '%s'\n", socket_path);
588                         goto error;
589                 }
590                 chan_infos[i] = chan_info;
591                 strlcpy(chan_info->channel_path, socket_path,
592                                 sizeof(chan_info->channel_path));
593
594                 if (setup_host_channel_info(&chan_info, i) < 0) {
595                         rte_free(chan_info);
596                         chan_infos[i] = NULL;
597                         goto error;
598                 }
599                 num_channels_enabled++;
600         }
601
602         return num_channels_enabled;
603 error:
604         /* Clean up the channels opened before we hit an error. */
605         for (i = 0; i < ci->core_count; i++) {
606                 if (chan_infos[i] != NULL) {
607                         remove_channel_from_monitor(chan_infos[i]);
608                         close(chan_infos[i]->fd);
609                         rte_free(chan_infos[i]);
610                 }
611         }
612         return 0;
613 }
614
615 int
616 remove_channel(struct channel_info **chan_info_dptr)
617 {
618         struct virtual_machine_info *vm_info;
619         struct channel_info *chan_info = *chan_info_dptr;
620
621         close(chan_info->fd);
622
623         vm_info = (struct virtual_machine_info *)chan_info->priv_info;
624
625         rte_spinlock_lock(&(vm_info->config_spinlock));
626         vm_info->channel_mask[chan_info->channel_num] = 0;
627         vm_info->num_channels--;
628         rte_spinlock_unlock(&(vm_info->config_spinlock));
629
630         rte_free(chan_info);
631         return 0;
632 }
633
634 int
635 set_channel_status_all(const char *vm_name, enum channel_status status)
636 {
637         struct virtual_machine_info *vm_info;
638         unsigned i;
639         char mask[RTE_MAX_LCORE];
640         int num_channels_changed = 0;
641
642         if (!(status == CHANNEL_MGR_CHANNEL_CONNECTED ||
643                         status == CHANNEL_MGR_CHANNEL_DISABLED)) {
644                 RTE_LOG(ERR, CHANNEL_MANAGER, "Channels can only be enabled or "
645                                 "disabled: Unable to change status for VM '%s'\n", vm_name);
646         }
647         vm_info = find_domain_by_name(vm_name);
648         if (vm_info == NULL) {
649                 RTE_LOG(ERR, CHANNEL_MANAGER, "Unable to disable channels: VM '%s' "
650                                 "not found\n", vm_name);
651                 return 0;
652         }
653
654         rte_spinlock_lock(&(vm_info->config_spinlock));
655         memcpy(mask, (char *)vm_info->channel_mask, RTE_MAX_LCORE);
656         for (i = 0; i < RTE_MAX_LCORE; i++) {
657                 if (mask[i] != 1)
658                         continue;
659                 vm_info->channels[i]->status = status;
660                 num_channels_changed++;
661         }
662         rte_spinlock_unlock(&(vm_info->config_spinlock));
663         return num_channels_changed;
664
665 }
666
667 int
668 set_channel_status(const char *vm_name, unsigned *channel_list,
669                 unsigned len_channel_list, enum channel_status status)
670 {
671         struct virtual_machine_info *vm_info;
672         unsigned i;
673         int num_channels_changed = 0;
674
675         if (!(status == CHANNEL_MGR_CHANNEL_CONNECTED ||
676                         status == CHANNEL_MGR_CHANNEL_DISABLED)) {
677                 RTE_LOG(ERR, CHANNEL_MANAGER, "Channels can only be enabled or "
678                                 "disabled: Unable to change status for VM '%s'\n", vm_name);
679         }
680         vm_info = find_domain_by_name(vm_name);
681         if (vm_info == NULL) {
682                 RTE_LOG(ERR, CHANNEL_MANAGER, "Unable to add channels: VM '%s' "
683                                 "not found\n", vm_name);
684                 return 0;
685         }
686         for (i = 0; i < len_channel_list; i++) {
687                 if (channel_exists(vm_info, channel_list[i])) {
688                         rte_spinlock_lock(&(vm_info->config_spinlock));
689                         vm_info->channels[channel_list[i]]->status = status;
690                         rte_spinlock_unlock(&(vm_info->config_spinlock));
691                         num_channels_changed++;
692                 }
693         }
694         return num_channels_changed;
695 }
696
697 void
698 get_all_vm(int *num_vm, int *num_vcpu)
699 {
700
701         virNodeInfo node_info;
702         virDomainPtr *domptr;
703         int i, ii, numVcpus[MAX_VCPUS], n_vcpus;
704         unsigned int jj;
705         const char *vm_name;
706         unsigned int domain_flags = VIR_CONNECT_LIST_DOMAINS_RUNNING |
707                                 VIR_CONNECT_LIST_DOMAINS_PERSISTENT;
708         unsigned int domain_flag = VIR_DOMAIN_VCPU_CONFIG;
709
710         if (!global_hypervisor_available)
711                 return;
712
713         memset(global_cpumaps, 0, RTE_MAX_LCORE*global_maplen);
714         if (virNodeGetInfo(global_vir_conn_ptr, &node_info)) {
715                 RTE_LOG(ERR, CHANNEL_MANAGER, "Unable to retrieve node Info\n");
716                 return;
717         }
718
719         /* Returns number of pcpus */
720         global_n_host_cpus = (unsigned int)node_info.cpus;
721
722         /* Returns number of active domains */
723         *num_vm = virConnectListAllDomains(global_vir_conn_ptr, &domptr,
724                                         domain_flags);
725         if (*num_vm <= 0) {
726                 RTE_LOG(ERR, CHANNEL_MANAGER, "No Active Domains Running\n");
727                 return;
728         }
729
730         for (i = 0; i < *num_vm; i++) {
731
732                 /* Get Domain Names */
733                 vm_name = virDomainGetName(domptr[i]);
734                 lvm_info[i].vm_name = vm_name;
735
736                 /* Get Number of Vcpus */
737                 numVcpus[i] = virDomainGetVcpusFlags(domptr[i], domain_flag);
738
739                 /* Get Number of VCpus & VcpuPinInfo */
740                 n_vcpus = virDomainGetVcpuPinInfo(domptr[i],
741                                 numVcpus[i], global_cpumaps,
742                                 global_maplen, domain_flag);
743
744                 if ((int)n_vcpus > 0) {
745                         *num_vcpu = n_vcpus;
746                         lvm_info[i].num_cpus = n_vcpus;
747                 }
748
749                 /* Save pcpu in use by libvirt VMs */
750                 for (ii = 0; ii < n_vcpus; ii++) {
751                         for (jj = 0; jj < global_n_host_cpus; jj++) {
752                                 if (VIR_CPU_USABLE(global_cpumaps,
753                                                 global_maplen, ii, jj) > 0) {
754                                         lvm_info[i].pcpus[ii] = jj;
755                                 }
756                         }
757                 }
758         }
759 }
760
761 int
762 get_info_vm(const char *vm_name, struct vm_info *info)
763 {
764         struct virtual_machine_info *vm_info;
765         unsigned i, channel_num = 0;
766         char mask[RTE_MAX_LCORE];
767
768         vm_info = find_domain_by_name(vm_name);
769         if (vm_info == NULL) {
770                 RTE_LOG(ERR, CHANNEL_MANAGER, "VM '%s' not found\n", vm_name);
771                 return -1;
772         }
773         info->status = CHANNEL_MGR_VM_ACTIVE;
774         if (!virDomainIsActive(vm_info->domainPtr))
775                 info->status = CHANNEL_MGR_VM_INACTIVE;
776
777         rte_spinlock_lock(&(vm_info->config_spinlock));
778
779         memcpy(mask, (char *)vm_info->channel_mask, RTE_MAX_LCORE);
780         for (i = 0; i < RTE_MAX_LCORE; i++) {
781                 if (mask[i] != 1)
782                         continue;
783                 info->channels[channel_num].channel_num = i;
784                 memcpy(info->channels[channel_num].channel_path,
785                                 vm_info->channels[i]->channel_path,
786                                 UNIX_PATH_MAX);
787                 info->channels[channel_num].status =
788                                 vm_info->channels[i]->status;
789                 info->channels[channel_num].fd =
790                                 vm_info->channels[i]->fd;
791                 channel_num++;
792         }
793
794         info->num_channels = channel_num;
795         info->num_vcpus = vm_info->info.nrVirtCpu;
796         rte_spinlock_unlock(&(vm_info->config_spinlock));
797
798         memcpy(info->name, vm_info->name, sizeof(vm_info->name));
799         rte_spinlock_lock(&(vm_info->config_spinlock));
800         for (i = 0; i < info->num_vcpus; i++) {
801                 info->pcpu_map[i] = vm_info->pcpu_map[i];
802         }
803         rte_spinlock_unlock(&(vm_info->config_spinlock));
804         return 0;
805 }
806
807 int
808 add_vm(const char *vm_name)
809 {
810         struct virtual_machine_info *new_domain;
811         virDomainPtr dom_ptr;
812         int i;
813
814         if (find_domain_by_name(vm_name) != NULL) {
815                 RTE_LOG(ERR, CHANNEL_MANAGER, "Unable to add VM: VM '%s' "
816                                 "already exists\n", vm_name);
817                 return -1;
818         }
819
820         if (global_vir_conn_ptr == NULL) {
821                 RTE_LOG(ERR, CHANNEL_MANAGER, "No connection to hypervisor exists\n");
822                 return -1;
823         }
824         dom_ptr = virDomainLookupByName(global_vir_conn_ptr, vm_name);
825         if (dom_ptr == NULL) {
826                 RTE_LOG(ERR, CHANNEL_MANAGER, "Error on VM lookup with libvirt: "
827                                 "VM '%s' not found\n", vm_name);
828                 return -1;
829         }
830
831         new_domain = rte_malloc("virtual_machine_info", sizeof(*new_domain),
832                         RTE_CACHE_LINE_SIZE);
833         if (new_domain == NULL) {
834                 RTE_LOG(ERR, CHANNEL_MANAGER, "Unable to allocate memory for VM "
835                                 "info\n");
836                 return -1;
837         }
838         new_domain->domainPtr = dom_ptr;
839         if (virDomainGetInfo(new_domain->domainPtr, &new_domain->info) != 0) {
840                 RTE_LOG(ERR, CHANNEL_MANAGER, "Unable to get libvirt VM info\n");
841                 rte_free(new_domain);
842                 return -1;
843         }
844         if (new_domain->info.nrVirtCpu > RTE_MAX_LCORE) {
845                 RTE_LOG(ERR, CHANNEL_MANAGER, "Error the number of virtual CPUs(%u) is "
846                                 "greater than allowable(%d)\n", new_domain->info.nrVirtCpu,
847                                 RTE_MAX_LCORE);
848                 rte_free(new_domain);
849                 return -1;
850         }
851
852         for (i = 0; i < RTE_MAX_LCORE; i++)
853                 new_domain->pcpu_map[i] = 0;
854
855         if (update_pcpus_mask(new_domain) < 0) {
856                 RTE_LOG(ERR, CHANNEL_MANAGER, "Error getting physical CPU pinning\n");
857                 rte_free(new_domain);
858                 return -1;
859         }
860         strncpy(new_domain->name, vm_name, sizeof(new_domain->name));
861         new_domain->name[sizeof(new_domain->name) - 1] = '\0';
862         memset(new_domain->channel_mask, 0, RTE_MAX_LCORE);
863         new_domain->num_channels = 0;
864
865         if (!virDomainIsActive(dom_ptr))
866                 new_domain->status = CHANNEL_MGR_VM_INACTIVE;
867         else
868                 new_domain->status = CHANNEL_MGR_VM_ACTIVE;
869
870         rte_spinlock_init(&(new_domain->config_spinlock));
871         LIST_INSERT_HEAD(&vm_list_head, new_domain, vms_info);
872         return 0;
873 }
874
875 int
876 remove_vm(const char *vm_name)
877 {
878         struct virtual_machine_info *vm_info = find_domain_by_name(vm_name);
879
880         if (vm_info == NULL) {
881                 RTE_LOG(ERR, CHANNEL_MANAGER, "Unable to remove VM: VM '%s' "
882                                 "not found\n", vm_name);
883                 return -1;
884         }
885         rte_spinlock_lock(&vm_info->config_spinlock);
886         if (vm_info->num_channels != 0) {
887                 RTE_LOG(ERR, CHANNEL_MANAGER, "Unable to remove VM '%s', there are "
888                                 "%"PRId8" channels still active\n",
889                                 vm_name, vm_info->num_channels);
890                 rte_spinlock_unlock(&vm_info->config_spinlock);
891                 return -1;
892         }
893         LIST_REMOVE(vm_info, vms_info);
894         rte_spinlock_unlock(&vm_info->config_spinlock);
895         rte_free(vm_info);
896         return 0;
897 }
898
899 static void
900 disconnect_hypervisor(void)
901 {
902         if (global_vir_conn_ptr != NULL) {
903                 virConnectClose(global_vir_conn_ptr);
904                 global_vir_conn_ptr = NULL;
905         }
906 }
907
908 static int
909 connect_hypervisor(const char *path)
910 {
911         if (global_vir_conn_ptr != NULL) {
912                 RTE_LOG(ERR, CHANNEL_MANAGER, "Error connecting to %s, connection "
913                                 "already established\n", path);
914                 return -1;
915         }
916         global_vir_conn_ptr = virConnectOpen(path);
917         if (global_vir_conn_ptr == NULL) {
918                 RTE_LOG(ERR, CHANNEL_MANAGER, "Error failed to open connection to "
919                                 "Hypervisor '%s'\n", path);
920                 return -1;
921         }
922         return 0;
923 }
924 int
925 channel_manager_init(const char *path __rte_unused)
926 {
927         virNodeInfo info;
928
929         LIST_INIT(&vm_list_head);
930         if (connect_hypervisor(path) < 0) {
931                 global_n_host_cpus = 64;
932                 global_hypervisor_available = 0;
933                 RTE_LOG(INFO, CHANNEL_MANAGER, "Unable to initialize channel manager\n");
934         } else {
935                 global_hypervisor_available = 1;
936
937                 global_maplen = VIR_CPU_MAPLEN(RTE_MAX_LCORE);
938
939                 global_vircpuinfo = rte_zmalloc(NULL,
940                                 sizeof(*global_vircpuinfo) *
941                                 RTE_MAX_LCORE, RTE_CACHE_LINE_SIZE);
942                 if (global_vircpuinfo == NULL) {
943                         RTE_LOG(ERR, CHANNEL_MANAGER, "Error allocating memory for CPU Info\n");
944                         goto error;
945                 }
946                 global_cpumaps = rte_zmalloc(NULL,
947                                 RTE_MAX_LCORE * global_maplen,
948                                 RTE_CACHE_LINE_SIZE);
949                 if (global_cpumaps == NULL)
950                         goto error;
951
952                 if (virNodeGetInfo(global_vir_conn_ptr, &info)) {
953                         RTE_LOG(ERR, CHANNEL_MANAGER, "Unable to retrieve node Info\n");
954                         goto error;
955                 }
956                 global_n_host_cpus = (unsigned int)info.cpus;
957         }
958
959
960
961         if (global_n_host_cpus > RTE_MAX_LCORE) {
962                 RTE_LOG(WARNING, CHANNEL_MANAGER, "The number of host CPUs(%u) exceeds the "
963                                 "maximum of %u. No cores over %u should be used.\n",
964                                 global_n_host_cpus, RTE_MAX_LCORE,
965                                 RTE_MAX_LCORE - 1);
966                 global_n_host_cpus = RTE_MAX_LCORE;
967         }
968
969         return 0;
970 error:
971         if (global_hypervisor_available)
972                 disconnect_hypervisor();
973         return -1;
974 }
975
976 void
977 channel_manager_exit(void)
978 {
979         unsigned i;
980         char mask[RTE_MAX_LCORE];
981         struct virtual_machine_info *vm_info;
982
983         LIST_FOREACH(vm_info, &vm_list_head, vms_info) {
984
985                 rte_spinlock_lock(&(vm_info->config_spinlock));
986
987                 memcpy(mask, (char *)vm_info->channel_mask, RTE_MAX_LCORE);
988                 for (i = 0; i < RTE_MAX_LCORE; i++) {
989                         if (mask[i] != 1)
990                                 continue;
991                         remove_channel_from_monitor(
992                                         vm_info->channels[i]);
993                         close(vm_info->channels[i]->fd);
994                         rte_free(vm_info->channels[i]);
995                 }
996                 rte_spinlock_unlock(&(vm_info->config_spinlock));
997
998                 LIST_REMOVE(vm_info, vms_info);
999                 rte_free(vm_info);
1000         }
1001
1002         if (global_hypervisor_available) {
1003                 /* Only needed if hypervisor available */
1004                 rte_free(global_cpumaps);
1005                 rte_free(global_vircpuinfo);
1006                 disconnect_hypervisor();
1007         }
1008 }