examples/l2fwd: add forwarding port mapping option

[dpdk.git] / examples / vm_power_manager / channel_monitor.c

diff --git a/examples/vm_power_manager/channel_monitor.c b/examples/vm_power_manager/channel_monitor.c
index 29e1cb6..1d00a6c 100644 (file)
--- a/examples/vm_power_manager/channel_monitor.c
+++ b/examples/vm_power_manager/channel_monitor.c
@@ -31,6 +31,7 @@
 #ifdef RTE_LIBRTE_I40E_PMD
 #include <rte_pmd_i40e.h>
 #endif
+#include <rte_power.h>
 
 #include <libvirt/libvirt.h>
 #include "channel_monitor.h"
@@ -684,10 +685,14 @@ apply_policy(struct policy *pol)
 }
 
 static int
-write_binary_packet(struct channel_packet *pkt, struct channel_info *chan_info)
+write_binary_packet(void *buffer,
+               size_t buffer_len,
+               struct channel_info *chan_info)
 {
-       int ret, buffer_len = sizeof(*pkt);
-       void *buffer = pkt;
+       int ret;
+
+       if (buffer_len == 0 || buffer == NULL)
+               return -1;
 
        if (chan_info->fd < 0) {
                RTE_LOG(ERR, CHANNEL_MONITOR, "Channel is not connected\n");
@@ -709,13 +714,105 @@ write_binary_packet(struct channel_packet *pkt, struct channel_info *chan_info)
        return 0;
 }
 
+static int
+send_freq(struct channel_packet *pkt,
+               struct channel_info *chan_info,
+               bool freq_list)
+{
+       unsigned int vcore_id = pkt->resource_id;
+       struct channel_packet_freq_list channel_pkt_freq_list;
+       struct vm_info info;
+
+       if (get_info_vm(pkt->vm_name, &info) != 0)
+               return -1;
+
+       if (!freq_list && vcore_id >= MAX_VCPU_PER_VM)
+               return -1;
+
+       if (!info.allow_query)
+               return -1;
+
+       channel_pkt_freq_list.command = CPU_POWER_FREQ_LIST;
+       channel_pkt_freq_list.num_vcpu = info.num_vcpus;
+
+       if (freq_list) {
+               unsigned int i;
+               for (i = 0; i < info.num_vcpus; i++)
+                       channel_pkt_freq_list.freq_list[i] =
+                         power_manager_get_current_frequency(info.pcpu_map[i]);
+       } else {
+               channel_pkt_freq_list.freq_list[vcore_id] =
+                 power_manager_get_current_frequency(info.pcpu_map[vcore_id]);
+       }
+
+       return write_binary_packet(&channel_pkt_freq_list,
+                       sizeof(channel_pkt_freq_list),
+                       chan_info);
+}
+
+static int
+send_capabilities(struct channel_packet *pkt,
+               struct channel_info *chan_info,
+               bool list_requested)
+{
+       unsigned int vcore_id = pkt->resource_id;
+       struct channel_packet_caps_list channel_pkt_caps_list;
+       struct vm_info info;
+       struct rte_power_core_capabilities caps;
+       int ret;
+
+       if (get_info_vm(pkt->vm_name, &info) != 0)
+               return -1;
+
+       if (!list_requested && vcore_id >= MAX_VCPU_PER_VM)
+               return -1;
+
+       if (!info.allow_query)
+               return -1;
+
+       channel_pkt_caps_list.command = CPU_POWER_CAPS_LIST;
+       channel_pkt_caps_list.num_vcpu = info.num_vcpus;
+
+       if (list_requested) {
+               unsigned int i;
+               for (i = 0; i < info.num_vcpus; i++) {
+                       ret = rte_power_get_capabilities(info.pcpu_map[i],
+                                       &caps);
+                       if (ret == 0) {
+                               channel_pkt_caps_list.turbo[i] =
+                                               caps.turbo;
+                               channel_pkt_caps_list.priority[i] =
+                                               caps.priority;
+                       } else
+                               return -1;
+
+               }
+       } else {
+               ret = rte_power_get_capabilities(info.pcpu_map[vcore_id],
+                               &caps);
+               if (ret == 0) {
+                       channel_pkt_caps_list.turbo[vcore_id] =
+                                       caps.turbo;
+                       channel_pkt_caps_list.priority[vcore_id] =
+                                       caps.priority;
+               } else
+                       return -1;
+       }
+
+       return write_binary_packet(&channel_pkt_caps_list,
+                       sizeof(channel_pkt_caps_list),
+                       chan_info);
+}
+
 static int
 send_ack_for_received_cmd(struct channel_packet *pkt,
                struct channel_info *chan_info,
                uint32_t command)
 {
        pkt->command = command;
-       return write_binary_packet(pkt, chan_info);
+       return write_binary_packet(pkt,
+                       sizeof(struct channel_packet),
+                       chan_info);
 }
 
 static int
@@ -741,8 +838,8 @@ process_request(struct channel_packet *pkt, struct channel_info *chan_info)
                RTE_LOG(DEBUG, CHANNEL_MONITOR, "Processing requested cmd for cpu:%d\n",
                        core_num);
 
-               bool valid_unit = true;
                int scale_res;
+               bool valid_unit = true;
 
                switch (pkt->unit) {
                case(CPU_POWER_SCALE_MIN):
@@ -771,13 +868,13 @@ process_request(struct channel_packet *pkt, struct channel_info *chan_info)
                if (valid_unit) {
                        ret = send_ack_for_received_cmd(pkt,
                                        chan_info,
-                                       scale_res > 0 ?
+                                       scale_res >= 0 ?
                                                CPU_POWER_CMD_ACK :
                                                CPU_POWER_CMD_NACK);
                        if (ret < 0)
-                               RTE_LOG(DEBUG, CHANNEL_MONITOR, "Error during sending ack command.\n");
+                               RTE_LOG(ERR, CHANNEL_MONITOR, "Error during sending ack command.\n");
                } else
-                       RTE_LOG(DEBUG, CHANNEL_MONITOR, "Unexpected unit type.\n");
+                       RTE_LOG(ERR, CHANNEL_MONITOR, "Unexpected unit type.\n");
 
        }
 
@@ -788,7 +885,7 @@ process_request(struct channel_packet *pkt, struct channel_info *chan_info)
                                chan_info,
                                CPU_POWER_CMD_ACK);
                if (ret < 0)
-                       RTE_LOG(DEBUG, CHANNEL_MONITOR, "Error during sending ack command.\n");
+                       RTE_LOG(ERR, CHANNEL_MONITOR, "Error during sending ack command.\n");
                update_policy(pkt);
                policy_is_set = 1;
        }
@@ -803,6 +900,30 @@ process_request(struct channel_packet *pkt, struct channel_info *chan_info)
                                 "Policy %s does not exist\n", pkt->vm_name);
        }
 
+       if (pkt->command == CPU_POWER_QUERY_FREQ_LIST ||
+               pkt->command == CPU_POWER_QUERY_FREQ) {
+
+               RTE_LOG(INFO, CHANNEL_MONITOR,
+                       "Frequency for %s requested.\n", pkt->vm_name);
+               int ret = send_freq(pkt,
+                               chan_info,
+                               pkt->command == CPU_POWER_QUERY_FREQ_LIST);
+               if (ret < 0)
+                       RTE_LOG(ERR, CHANNEL_MONITOR, "Error during frequency sending.\n");
+       }
+
+       if (pkt->command == CPU_POWER_QUERY_CAPS_LIST ||
+               pkt->command == CPU_POWER_QUERY_CAPS) {
+
+               RTE_LOG(INFO, CHANNEL_MONITOR,
+                       "Capabilities for %s requested.\n", pkt->vm_name);
+               int ret = send_capabilities(pkt,
+                               chan_info,
+                               pkt->command == CPU_POWER_QUERY_CAPS_LIST);
+               if (ret < 0)
+                       RTE_LOG(ERR, CHANNEL_MONITOR, "Error during sending capabilities.\n");
+       }
+
        /*
         * Return is not checked as channel status may have been set to DISABLED
         * from management thread