VOL-1236: BAL upgrade for 2.6 and support for Traffic Shaping
Change-Id: If12f914e5981b2eabfca90a70dbb0f0750a76c4b
diff --git a/src/voltha_bal_driver.c b/src/voltha_bal_driver.c
new file mode 100755
index 0000000..12b7fcf
--- /dev/null
+++ b/src/voltha_bal_driver.c
@@ -0,0 +1,1267 @@
+/*
+** Copyright 2017-present Open Networking Foundation
+**
+** Licensed under the Apache License, Version 2.0 (the "License");
+** you may not use this file except in compliance with the License.
+** You may obtain a copy of the License at
+**
+** http://www.apache.org/licenses/LICENSE-2.0
+**
+** Unless required by applicable law or agreed to in writing, software
+** distributed under the License is distributed on an "AS IS" BASIS,
+** WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+** See the License for the specific language governing permissions and
+** limitations under the License.
+*/
+#include <signal.h>
+#include <stdio.h>
+#include <string.h>
+#include <unistd.h>
+#include <string.h>
+#include <stdlib.h>
+#include <stdbool.h>
+#include <sys/time.h>
+#include "bal_msg_type.grpc-c.h"
+#include "bal_osmsg.grpc-c.h"
+#include "bal_model_ids.grpc-c.h"
+#include "bal_obj.grpc-c.h"
+#include "bal_model_types.grpc-c.h"
+#include "bal_errno.grpc-c.h"
+#include "bal.grpc-c.h"
+#include "asfvolt.grpc-c.h"
+
+#include "asfvolt16_driver.h"
+
+#include <sys/reboot.h>
+#include "bal_indications_queue.h"
+
+/* Global varibles */
+balCoreIpInfo coreIpPortInfo;
+
+/* extern variables*/
+list_node *bal_ind_queue_tail = NULL;
+list_node *bal_ind_queue_head = NULL;
+pthread_mutex_t bal_ind_queue_lock;
+unsigned int num_of_nodes = 0;
+
+/* static variables*/
+static grpc_c_server_t *test_server;
+static void sigint_handler (int x) {
+ grpc_c_server_destroy(test_server);
+ exit(0);
+}
+static bool is_init_done = false;
+
+/*MACRO Definitions*/
+#define ASFVOLT_FIELD_LEN 200
+
+void is_grpc_write_pending(int return_value)
+{
+ if (return_value != GRPC_C_WRITE_OK)
+ {
+ if(return_value == GRPC_C_WRITE_PENDING)
+ {
+ /* TODO: Register call back with grpc-c which will give an indication whenever write was succussful */
+ ASFVOLT_LOG(ASFVOLT_INFO, "write(%d) is pending, sleep for 5 sec", return_value);
+ sleep(5);
+ }
+ else
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Failed to write %d", return_value);
+ }
+ }
+
+}
+
+/*
+ * This functions gets invoked whenever bal Heartbeat RPC gets called
+ */
+void bal__bal_api_heartbeat_cb(grpc_c_context_t *context)
+{
+ BalHeartbeat *bal_hb;
+ BalRebootState bal_reboot;
+ int ret_val;
+ /*
+ * Read incoming message into set_cfg
+ */
+ if (context->gcc_payload) {
+ context->gcc_stream->read(context, (void **)&bal_hb, 0);
+ }
+
+ bal_reboot_state__init(&bal_reboot);
+
+ bal_reboot.has_is_reboot = 1;
+ bal_reboot.is_reboot = is_reboot;
+
+ /*
+ * Write reply back to the client
+ */
+ ret_val = context->gcc_stream->write(context, &bal_reboot, -1);
+ is_grpc_write_pending(ret_val);
+
+ grpc_c_status_t status;
+ status.gcs_code = 0;
+
+ /*
+ * Finish response for RPC
+ */
+ if (context->gcc_stream->finish(context, &status))
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Failed to write status");
+ }
+}
+
+/*
+ * This functions gets invoked whenever Bal reboot gets called
+ */
+void bal__bal_api_reboot_cb(grpc_c_context_t *context)
+{
+ BalReboot *read_device;
+ BalErr bal_err;
+ int ret_val;
+
+ /*
+ * Read incoming message into get_cfg
+ */
+ if (context->gcc_payload)
+ {
+ context->gcc_stream->read(context, (void **)&read_device, 0);
+ ASFVOLT_LOG(ASFVOLT_INFO, "Bal Server - Reboot : Device ID is %s",read_device->device_id);
+ }
+
+
+ /*
+ * send it to BAL
+ */
+
+ bal_err__init(&bal_err);
+
+ bal_err.err= 0;
+
+ /*
+ * Write reply back to the client
+ */
+ ret_val = context->gcc_stream->write(context, &bal_err, -1);
+ is_grpc_write_pending(ret_val);
+
+ grpc_c_status_t status;
+ status.gcs_code = 0;
+
+ /*
+ * Finish response for RPC
+ */
+ if (context->gcc_stream->finish(context, &status))
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Failed to write status");
+ }
+
+ ret_val = system("shutdown -r now");
+ sleep(30); /* allow system to shutdown gracefully */
+ sync(); /* force shutdown if graceful did not work */
+ reboot(RB_AUTOBOOT);
+}
+
+/*
+This function reads the specified field from the 'onldump -o' command.
+If the field was successfully read, it returns the field value.
+If it failed to read the field, then null charecter is returned
+*/
+char* asfvolt_read_sysinfo(char* field_name, char* field_val)
+{
+ FILE *fp;
+ /* Prepare the command*/
+ char command[150];
+
+ snprintf(command, sizeof command, "bash -l -c \"onlpdump -s\" | perl -ne 'print $1 if /%s: (\\S+)/'", field_name);
+ /* Open the command for reading. */
+ fp = popen(command, "r");
+ if (fp == NULL) {
+ /*The client has to check for a Null mac address in this case*/
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Failed to query the mac address");
+ return field_val;
+ }
+
+ /*Read the field value*/
+ if (fp) {
+ fread(field_val, ASFVOLT_FIELD_LEN, 1, fp);
+ pclose(fp);
+ }
+ return field_val;
+}
+
+/*
+ * This functions gets invoked whenever AsfvoltGetSystemInfo RPC gets called
+ */
+void asfvolt__asfvolt_get_system_info_cb(grpc_c_context_t *context)
+{
+ BalDefault *dummy;
+ AsfSystemInfo asf_system_info;
+ char product_name[ASFVOLT_FIELD_LEN] = "\0";
+ char part_num[ASFVOLT_FIELD_LEN] = "\0";
+ char serial_num[ASFVOLT_FIELD_LEN] = "\0";
+ char mac_address[ASFVOLT_FIELD_LEN] = "\0";
+ char mac_range[ASFVOLT_FIELD_LEN] = "\0";
+ char manufacturer[ASFVOLT_FIELD_LEN] = "\0";
+ char manufacturer_date[ASFVOLT_FIELD_LEN] = "\0";
+ char vendor[ASFVOLT_FIELD_LEN] = "\0";
+ char platform_name[ASFVOLT_FIELD_LEN] = "\0";
+ char label_revision[ASFVOLT_FIELD_LEN] = "\0";
+ char coutry_code[ASFVOLT_FIELD_LEN] = "\0";
+ char diag_version[ASFVOLT_FIELD_LEN] = "\0";
+ char onie_version[ASFVOLT_FIELD_LEN] = "\0";
+ int ret_val;
+
+ if (context->gcc_payload) {
+ context->gcc_stream->read(context, (void **)&dummy, 0);
+ }
+
+ asf_system_info__init(&asf_system_info);
+
+ asf_system_info.product_name = asfvolt_read_sysinfo("Product Name", product_name);
+ asf_system_info.part_num = asfvolt_read_sysinfo("Part Number", part_num);
+ asf_system_info.serial_num = asfvolt_read_sysinfo("Serial Number", serial_num);
+ asf_system_info.mac_address = asfvolt_read_sysinfo("MAC", mac_address);
+ asf_system_info.mac_range = asfvolt_read_sysinfo("MAC Range", mac_range);
+ asf_system_info.manufacturer = asfvolt_read_sysinfo("Manufacturer", manufacturer);
+ asf_system_info.manufacture_date = asfvolt_read_sysinfo("Manufacture Date", manufacturer_date);
+ asf_system_info.vendor = asfvolt_read_sysinfo("Vendor", vendor);
+ asf_system_info.platform_name = asfvolt_read_sysinfo("Platform Name", platform_name);
+ asf_system_info.label_revision = asfvolt_read_sysinfo("Label Revision", label_revision);
+ asf_system_info.country_code = asfvolt_read_sysinfo("Country Code", coutry_code);
+ asf_system_info.diag_version = asfvolt_read_sysinfo("Diag Version", diag_version);
+ asf_system_info.onie_version = asfvolt_read_sysinfo("ONIE Version", onie_version);
+
+ /*
+ * Write reply back to the client
+ */
+ ret_val = context->gcc_stream->write(context, &asf_system_info, -1);
+ is_grpc_write_pending(ret_val);
+
+ grpc_c_status_t status;
+ status.gcs_code = 0;
+
+ /*
+ * Finish response for RPC
+ */
+ if (context->gcc_stream->finish(context, &status))
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Failed to write status");
+ }
+}
+
+/*
+This function reads the SFP presence map information from 'onlpdump -p' system command
+and returns a bitmap with the presence information.
+*/
+unsigned int asfvolt_read_sfp_presence_bitmap(void)
+{
+ char command[150];
+ char sfp_presence_output[ASFVOLT_FIELD_LEN];
+ unsigned int sfp_presence_bitmap = 0;
+ char delim[2] = " ";
+ char *field = NULL;
+ FILE *fp;
+ snprintf(command, sizeof command, "bash -l -c \"onlpdump -p\" | perl -ne 'print $1 if /Presence: ([0-9 ]+)/'");
+ /* Open the command for reading. */
+ fp = popen(command, "r");
+ if (fp == NULL) {
+ /*The client has to check for a Null mac address in this case*/
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Failed to query the sfp presence map");
+ return sfp_presence_bitmap;
+ }
+
+ /*Read the field value*/
+ fread(sfp_presence_output, ASFVOLT_FIELD_LEN, 1, fp);
+ pclose(fp);
+
+ field = strtok(sfp_presence_output, delim);
+ while (field != NULL) {
+ sfp_presence_bitmap |= (1 << atoi(field));
+ field = strtok(NULL, delim);
+ }
+
+ return sfp_presence_bitmap;
+}
+
+/*
+ * This functions gets invoked whenever AsfvoltGetSfpPresenceBitmap RPC gets called
+ */
+void asfvolt__asfvolt_get_sfp_presence_bitmap_cb(grpc_c_context_t *context)
+{
+ BalDefault *dummy;
+ AsfSfpPresenceBitmap sfp_presence_bitmap;
+ int ret_val;
+
+ if (context->gcc_payload) {
+ context->gcc_stream->read(context, (void **)&dummy, 0);
+ }
+
+ asf_sfp_presence_bitmap__init(&sfp_presence_bitmap);
+
+ sfp_presence_bitmap.bitmap = asfvolt_read_sfp_presence_bitmap();
+ sfp_presence_bitmap.has_bitmap = true;
+
+ /*
+ * Write reply back to the client
+ */
+ ret_val = context->gcc_stream->write(context, &sfp_presence_bitmap, -1);
+ is_grpc_write_pending(ret_val);
+
+ grpc_c_status_t status;
+ status.gcs_code = 0;
+
+ /*
+ * Finish response for RPC
+ */
+ if (context->gcc_stream->finish(context, &status))
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Failed to write status");
+ }
+}
+
+/*
+ * This functions gets invoked whenever Bal Stats gets called
+ */
+void bal__bal_cfg_stat_get_cb(grpc_c_context_t *context)
+{
+ BalInterfaceKey *read_stats = 0;
+ int ret_val;
+
+ /*
+ * Read incoming message into get_cfg
+ */
+ if (context->gcc_payload) {
+ context->gcc_stream->read(context, (void **)&read_stats, 0);
+ ASFVOLT_LOG(ASFVOLT_DEBUG, "Bal Server - Get Stats :NNI port is %d",read_stats->intf_id);
+ }
+
+
+ BalInterfaceStat get_stats;
+ memset(&get_stats, 0, sizeof(BalInterfaceStat));
+ bal_interface_stat__init(&get_stats);
+
+ BalInterfaceStatData stat_data;
+ memset(&stat_data, 0, sizeof(BalInterfaceStatData));
+ bal_interface_stat_data__init(&stat_data);
+
+ BalInterfaceKey stat_key;
+ memset(&stat_key, 0, sizeof(BalInterfaceKey));
+ bal_interface_key__init(&stat_key);
+
+ /* Interface Type, Interface ID
+ stat_data - Statistics Data */
+ if ((read_stats) && (is_init_done == true)) {
+ asfvolt16_bal_stats_get(read_stats->intf_type, read_stats->intf_id, &stat_data, &stat_key);
+ }
+
+ get_stats.data = &stat_data;
+ get_stats.key = &stat_key;
+
+ ret_val = context->gcc_stream->write(context, &get_stats, -1);
+ is_grpc_write_pending(ret_val);
+
+ grpc_c_status_t status;
+ status.gcs_code = 0;
+
+ /*
+ * Finish response for RPC
+ */
+ if (context->gcc_stream->finish(context, &status))
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Failed to write status");
+ }
+}
+
+void bal_cfg_get__free_mem_sub_term_cfg_get(BalCfg *balCfgRsp)
+{
+ free(balCfgRsp->terminal->data->password);
+ free(balCfgRsp->terminal->data->registration_id);
+ free(balCfgRsp->terminal->data->serial_number->vendor_id);
+ free(balCfgRsp->terminal->data->serial_number->vendor_specific);
+ free(balCfgRsp->terminal->data->serial_number);
+}
+
+void bal_cfg_get__free_mem(BalCfg *balCfgRsp)
+{
+ switch (balCfgRsp->hdr->obj_type)
+ {
+ case BAL_OBJ_ID__BAL_OBJ_ID_ACCESS_TERMINAL:
+ break;
+
+ case BAL_OBJ_ID__BAL_OBJ_ID_INTERFACE:
+ break;
+
+ case BAL_OBJ_ID__BAL_OBJ_ID_SUBSCRIBER_TERMINAL:
+ bal_cfg_get__free_mem_sub_term_cfg_get(balCfgRsp);
+ break;
+
+ default:
+ break;
+ }
+}
+
+/*
+ * This functions gets invoked whenever bal RPC gets called
+ */
+void bal__bal_cfg_get_cb(grpc_c_context_t *context)
+{
+ BalKey *bal_key = 0;
+ int ret_val;
+
+ /*
+ * Read incoming message into bal_key
+ */
+ if (context->gcc_payload) {
+ context->gcc_stream->read(context, (void **)&bal_key, 0);
+ }
+
+ /*
+ * send it to BAL
+ */
+ BalCfg get_cfg_resp;
+ memset(&get_cfg_resp, 0, sizeof(BalCfg));
+ bal_cfg__init(&get_cfg_resp);
+
+ BalObj hdr_cfg;
+ memset(&hdr_cfg, 0, sizeof(BalObj));
+ bal_obj__init(&hdr_cfg);
+ get_cfg_resp.hdr = &hdr_cfg;
+
+ BalCommMsgHdr comm_hdr;
+ memset(&comm_hdr, 0, sizeof(BalCommMsgHdr));
+ bal_comm_msg_hdr__init(&comm_hdr);
+ get_cfg_resp.hdr->comm_hdr = &comm_hdr;
+
+ if (bal_key) {
+ switch(bal_key->hdr->obj_type)
+ {
+ case BAL_OBJ_ID__BAL_OBJ_ID_ACCESS_TERMINAL:
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Bal Get For Access Terminal Received\n");
+
+ get_cfg_resp.obj_case = BAL_CFG__OBJ_CFG;
+
+ get_cfg_resp.hdr->obj_type = BAL_OBJ_ID__BAL_OBJ_ID_ACCESS_TERMINAL;
+
+ BalAccessTerminalCfg access_term_cfg;
+ memset(&access_term_cfg, 0, sizeof(BalAccessTerminalCfg));
+ bal_access_terminal_cfg__init(&access_term_cfg);
+ get_cfg_resp.cfg = &access_term_cfg;
+
+ BalAccessTerminalCfgData access_term_cfg_data;
+ memset(&access_term_cfg_data, 0, sizeof(BalAccessTerminalCfgData));
+ bal_access_terminal_cfg_data__init(&access_term_cfg_data);
+ get_cfg_resp.cfg->data = &access_term_cfg_data;
+
+ BalTopology access_term_cfg_data_topology;
+ memset(&access_term_cfg_data_topology, 0, sizeof(BalTopology));
+ bal_topology__init(&access_term_cfg_data_topology);
+ get_cfg_resp.cfg->data->topology = &access_term_cfg_data_topology;
+
+ BalSwVersion access_term_cfg_data_sw_version;
+ memset(&access_term_cfg_data_sw_version, 0, sizeof(BalSwVersion));
+ bal_sw_version__init(&access_term_cfg_data_sw_version);
+ get_cfg_resp.cfg->data->sw_version = &access_term_cfg_data_sw_version;
+
+ BalAccessTerminalKey access_term_key;
+ memset(&access_term_key, 0, sizeof(BalAccessTerminalKey));
+ bal_access_terminal_key__init(&access_term_key);
+ get_cfg_resp.cfg->key = &access_term_key;
+
+ if (is_init_done == true) {
+ asfvolt16_bal_cfg_get(&get_cfg_resp);
+ }
+ }
+ break;
+
+ case BAL_OBJ_ID__BAL_OBJ_ID_INTERFACE:
+ {
+ BalInterfaceCfg intf_cfg;
+ memset(&intf_cfg, 0, sizeof(BalInterfaceCfg));
+ bal_interface_cfg__init(&intf_cfg);
+ get_cfg_resp.interface = &intf_cfg;
+
+ BalInterfaceCfgData intf_cfg_data;
+ memset(&intf_cfg_data, 0, sizeof(BalInterfaceCfgData));
+ bal_interface_cfg_data__init(&intf_cfg_data);
+ get_cfg_resp.interface->data = &intf_cfg_data;
+
+ BalInterfaceKey intf_key;
+ memset(&intf_key, 0, sizeof(BalInterfaceKey));
+ bal_interface_key__init(&intf_key);
+ get_cfg_resp.interface->key = &intf_key;
+
+ if (is_init_done == true) {
+ asfvolt16_bal_cfg_get(&get_cfg_resp);
+ }
+ }
+ break;
+
+ case BAL_OBJ_ID__BAL_OBJ_ID_SUBSCRIBER_TERMINAL:
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Bal Get For Subscriber Terminal Received\n");
+
+ get_cfg_resp.obj_case = BAL_CFG__OBJ_TERMINAL;
+
+ get_cfg_resp.hdr->obj_type = BAL_OBJ_ID__BAL_OBJ_ID_SUBSCRIBER_TERMINAL;
+
+ BalSubscriberTerminalCfg sub_term_cfg;
+ memset(&sub_term_cfg, 0, sizeof(BalSubscriberTerminalCfg));
+ bal_subscriber_terminal_cfg__init(&sub_term_cfg);
+ get_cfg_resp.terminal = &sub_term_cfg;
+
+ BalSubscriberTerminalCfgData sub_term_cfg_data;
+ memset(&sub_term_cfg_data, 0, sizeof(BalSubscriberTerminalCfgData));
+ bal_subscriber_terminal_cfg_data__init(&sub_term_cfg_data);
+ get_cfg_resp.terminal->data = &sub_term_cfg_data;
+
+ BalSerialNumber serial_number;
+ memset(&serial_number, 0, sizeof(BalSerialNumber));
+ bal_serial_number__init(&serial_number);
+ get_cfg_resp.terminal->data->serial_number = &serial_number;
+
+ BalSubscriberTerminalKey sub_term_key;
+ memset(&sub_term_key, 0, sizeof(BalSubscriberTerminalKey));
+ bal_subscriber_terminal_key__init(&sub_term_key);
+ get_cfg_resp.terminal->key = &sub_term_key;
+
+ get_cfg_resp.terminal->key->has_sub_term_id = true;
+ get_cfg_resp.terminal->key->sub_term_id = bal_key->terminal_key->sub_term_id;
+
+ get_cfg_resp.terminal->key->has_intf_id = true;
+ get_cfg_resp.terminal->key->intf_id = bal_key->terminal_key->intf_id;
+
+ if (is_init_done == true) {
+ asfvolt16_bal_cfg_get(&get_cfg_resp);
+ }
+ }
+ break;
+ default:
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Bal Get not implemented for %d object type", bal_key->hdr->obj_type);
+ }
+ break;
+ }
+ }
+
+ /*
+ * Write reply back to the client
+ */
+ ret_val = context->gcc_stream->write(context, &get_cfg_resp, -1);
+ is_grpc_write_pending(ret_val);
+
+ grpc_c_status_t status;
+ status.gcs_code = 0;
+
+ /*
+ * Finish response for RPC
+ */
+ if (context->gcc_stream->finish(context, &status))
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Failed to write status");
+ }
+ bal_cfg_get__free_mem(&get_cfg_resp);
+}
+
+/*
+ * This functions gets invoked whenever bal RPC gets called
+ */
+void bal__bal_cfg_set_cb(grpc_c_context_t *context)
+{
+ BalCfg *set_cfg = 0;
+ BalErr bal_err;
+ int ret_val = 0;
+
+ /*
+ * Read incoming message into set_cfg
+ */
+ if (context->gcc_payload) {
+ context->gcc_stream->read(context, (void **)&set_cfg, 0);
+ }
+
+ /*
+ * send it to BAL
+ */
+
+ bal_err__init(&bal_err);
+
+ bal_err.err= 0;
+
+ /*
+ * Write reply back to the client
+ */
+
+ ret_val = context->gcc_stream->write(context, &bal_err, -1);
+ is_grpc_write_pending(ret_val);
+
+ grpc_c_status_t status;
+ status.gcs_code = 0;
+
+ /*
+ * Finish response for RPC
+ */
+ if (context->gcc_stream->finish(context, &status))
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Failed to write status");
+ }
+
+ if (set_cfg) {
+
+ if(BAL_OBJ_ID__BAL_OBJ_ID_ACCESS_TERMINAL == set_cfg->hdr->obj_type)
+ {
+ sleep(5); /* enable this if running with gdb */
+ }
+
+
+ asfvolt16_bal_cfg_set(set_cfg);
+ }
+}
+
+
+/*
+ * This functions gets invoked whenever bal clear RPC gets called
+ */
+void bal__bal_cfg_clear_cb(grpc_c_context_t *context)
+{
+ BalKey *clear_key = 0;
+ BalErr bal_err;
+ int ret_val = 0;
+
+ /*
+ * Read incoming message into clear_key
+ */
+ if (context->gcc_payload) {
+ context->gcc_stream->read(context, (void **)&clear_key, 0);
+ }
+
+ /*
+ * send it to BAL
+ */
+
+ bal_err__init(&bal_err);
+
+ bal_err.err= 0;
+
+ /*
+ * Write reply back to the client
+ */
+
+ ret_val = context->gcc_stream->write(context, &bal_err, 0);
+ is_grpc_write_pending(ret_val);
+
+ grpc_c_status_t status;
+ status.gcs_code = 0;
+
+ /*
+ * Finish response for RPC
+ */
+ if (context->gcc_stream->finish(context, &status))
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Failed to write status");
+ }
+
+ if (clear_key) {
+ asfvolt16_bal_cfg_clear(clear_key);
+ }
+}
+
+
+/*
+ * This functions gets invoked whenever bal Init RPC gets called
+ */
+void bal__bal_api_init_cb(grpc_c_context_t *context)
+{
+ BalInit *bal_init = 0;
+ BalErr bal_err;
+ int ret_val;
+
+ /*
+ * Read incoming message into set_cfg
+ */
+ if (context->gcc_payload)
+ {
+ context->gcc_stream->read(context, (void **)&bal_init, 0);
+ }
+
+ /*
+ * send it to BAL
+ */
+
+ ASFVOLT_LOG(ASFVOLT_INFO, "Received API Init msg");
+
+ bal_err__init(&bal_err);
+
+ bal_err.err= 0;
+
+ /*
+ * Write reply back to the client
+ */
+ ret_val = context->gcc_stream->write(context, &bal_err, -1);
+ is_grpc_write_pending(ret_val);
+
+ grpc_c_status_t status;
+ status.gcs_code = 0;
+
+ /*
+ * Finish response for RPC
+ */
+ if (context->gcc_stream->finish(context, &status))
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Failed to write status");
+ }
+
+ if (bal_init) {
+ asfvolt16_bal_init(bal_init, &coreIpPortInfo);
+ }
+ is_init_done = true;
+}
+
+
+void bal_get_ind__free_mem_access_term_ind_op_state(BalIndications *balIndCfg)
+{
+ free(balIndCfg->access_term_ind_op_state->data);
+ free(balIndCfg->access_term_ind_op_state->key);
+ free(balIndCfg->access_term_ind_op_state);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_access_term_proc_err(BalIndications *balIndCfg)
+{
+ free(balIndCfg->access_term_proc_err->key);
+ free(balIndCfg->access_term_proc_err);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_flow_op_state(BalIndications *balIndCfg)
+{
+ free(balIndCfg->flow_op_state->data);
+ free(balIndCfg->flow_op_state->key);
+ free(balIndCfg->flow_op_state);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_flow_proc_err(BalIndications *balIndCfg)
+{
+ free(balIndCfg->flow_proc_err->key);
+ free(balIndCfg->flow_proc_err);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_interface_op_state(BalIndications *balIndCfg)
+{
+ free(balIndCfg->interface_op_state->data);
+ free(balIndCfg->interface_op_state->key);
+ free(balIndCfg->interface_op_state);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_interface_los(BalIndications *balIndCfg)
+{
+ free(balIndCfg->interface_los->data);
+ free(balIndCfg->interface_los);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_terminal_op_state(BalIndications *balIndCfg)
+{
+ free(balIndCfg->terminal_op_state->data);
+ free(balIndCfg->terminal_op_state->key);
+ free(balIndCfg->terminal_op_state);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_terminal_disc(BalIndications *balIndCfg)
+{
+ free(balIndCfg->terminal_disc->data->serial_number->vendor_specific);
+ free(balIndCfg->terminal_disc->data->serial_number->vendor_id);
+ free(balIndCfg->terminal_disc->data->serial_number);
+ free(balIndCfg->terminal_disc->data);
+ free(balIndCfg->terminal_disc->key);
+ free(balIndCfg->terminal_disc);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_terminal_alarm(BalIndications *balIndCfg)
+{
+ free(balIndCfg->terminal_alarm->data->alarm);
+ free(balIndCfg->terminal_alarm->data);
+ free(balIndCfg->terminal_alarm->key);
+ free(balIndCfg->terminal_alarm);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_terminal_dgi(BalIndications *balIndCfg)
+{
+ free(balIndCfg->terminal_dgi->data);
+ free(balIndCfg->terminal_dgi->key);
+ free(balIndCfg->terminal_dgi);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_terminal_dowi(BalIndications *balIndCfg)
+{
+ free(balIndCfg->terminal_dowi->data);
+ free(balIndCfg->terminal_dowi->key);
+ free(balIndCfg->terminal_dowi);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_terminal_looci(BalIndications *balIndCfg)
+{
+ free(balIndCfg->terminal_looci->data);
+ free(balIndCfg->terminal_looci->key);
+ free(balIndCfg->terminal_looci);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_terminal_proc_err(BalIndications *balIndCfg)
+{
+ free(balIndCfg->terminal_proc_err->key);
+ free(balIndCfg->terminal_proc_err);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_terminal_sdi(BalIndications *balIndCfg)
+{
+ free(balIndCfg->terminal_sdi->data);
+ free(balIndCfg->terminal_sdi->key);
+ free(balIndCfg->terminal_sdi);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_terminal_sfi(BalIndications *balIndCfg)
+{
+ free(balIndCfg->terminal_sfi->data);
+ free(balIndCfg->terminal_sfi->key);
+ free(balIndCfg->terminal_sfi);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_terminal_sufi(BalIndications *balIndCfg)
+{
+ free(balIndCfg->terminal_sufi->data);
+ free(balIndCfg->terminal_sufi->key);
+ free(balIndCfg->terminal_sufi);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_terminal_sub_term_act_fail(BalIndications *balIndCfg)
+{
+ free(balIndCfg->terminal_sub_term_act_fail->data);
+ free(balIndCfg->terminal_sub_term_act_fail->key);
+ free(balIndCfg->terminal_sub_term_act_fail);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_terminal_tiwi(BalIndications *balIndCfg)
+{
+ free(balIndCfg->terminal_tiwi->data);
+ free(balIndCfg->terminal_tiwi->key);
+ free(balIndCfg->terminal_tiwi);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_tm_sched_osc(BalIndications *balIndCfg)
+{
+ free(balIndCfg->tm_sched_oper_stats_change->data);
+ free(balIndCfg->tm_sched_oper_stats_change->key);
+ free(balIndCfg->tm_sched_oper_stats_change);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_u_pkt_data(BalIndications *balIndCfg)
+{
+ free(balIndCfg->pktdata->data->pkt.data);
+ free(balIndCfg->pktdata->data);
+ switch(balIndCfg->pktdata->key->packet_send_dest->type)
+ {
+ case BAL_DEST_TYPE__BAL_DEST_TYPE_NNI:
+ free(balIndCfg->pktdata->key->packet_send_dest->nni);
+ break;
+ case BAL_DEST_TYPE__BAL_DEST_TYPE_SUB_TERM:
+ free(balIndCfg->pktdata->key->packet_send_dest->sub_term);
+ break;
+ case BAL_DEST_TYPE__BAL_DEST_TYPE_SVC_PORT:
+ free(balIndCfg->pktdata->key->packet_send_dest->svc_port);
+ break;
+ default:
+ /*Nothing to do*/
+ break;
+ }
+ free(balIndCfg->pktdata->key->packet_send_dest);
+ free(balIndCfg->pktdata->key);
+ free(balIndCfg->pktdata);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_u_bal_omci_resp(BalIndications *balIndCfg)
+{
+ switch(balIndCfg->balomciresp->key->packet_send_dest->type)
+ {
+ case BAL_DEST_TYPE__BAL_DEST_TYPE_ITU_OMCI_CHANNEL:
+ free(balIndCfg->balomciresp->key->packet_send_dest->itu_omci_channel);
+ break;
+ default:
+ /*Nothing to do*/
+ break;
+ }
+ free(balIndCfg->balomciresp->key->packet_send_dest);
+ free(balIndCfg->balomciresp->data->pkt.data);
+ free(balIndCfg->balomciresp->data);
+ free(balIndCfg->balomciresp->key);
+ free(balIndCfg->balomciresp);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem_u_bal_oam_resp(BalIndications *balIndCfg)
+{
+ free(balIndCfg->baloamresp->data->pkt.data);
+ free(balIndCfg->baloamresp->data);
+ switch(balIndCfg->baloamresp->key->packet_send_dest->type)
+ {
+ case BAL_DEST_TYPE__BAL_DEST_TYPE_IEEE_OAM_CHANNEL:
+ free(balIndCfg->baloamresp->key->packet_send_dest->ieee_oam_channel);
+ break;
+ default:
+ /*Nothing to do*/
+ break;
+ }
+ free(balIndCfg->baloamresp->key->packet_send_dest);
+ free(balIndCfg->baloamresp->key);
+ free(balIndCfg->baloamresp);
+ free(balIndCfg);
+}
+
+void bal_get_ind__free_mem(BalIndications *balIndCfg)
+{
+ switch (balIndCfg->u_case)
+ {
+ case BAL_INDICATIONS__U_ACCESS_TERM_IND_OP_STATE:
+ bal_get_ind__free_mem_access_term_ind_op_state(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_ACCESS_TERM_PROC_ERR:
+ bal_get_ind__free_mem_access_term_proc_err(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_FLOW_OP_STATE:
+ bal_get_ind__free_mem_flow_op_state(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_FLOW_PROC_ERR:
+ bal_get_ind__free_mem_flow_proc_err(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_INTERFACE_OP_STATE:
+ bal_get_ind__free_mem_interface_op_state(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_INTERFACE_LOS:
+ bal_get_ind__free_mem_interface_los(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_TERMINAL_OP_STATE:
+ bal_get_ind__free_mem_terminal_op_state(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_TERMINAL_DISC:
+ bal_get_ind__free_mem_terminal_disc(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_TERMINAL_ALARM:
+ bal_get_ind__free_mem_terminal_alarm(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_TERMINAL_DGI:
+ bal_get_ind__free_mem_terminal_dgi(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_TERMINAL_DOWI:
+ bal_get_ind__free_mem_terminal_dowi(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_TERMINAL_LOOCI:
+ bal_get_ind__free_mem_terminal_looci(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_TERMINAL_PROC_ERR:
+ bal_get_ind__free_mem_terminal_proc_err(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_TERMINAL_SDI:
+ bal_get_ind__free_mem_terminal_sdi(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_TERMINAL_SFI:
+ bal_get_ind__free_mem_terminal_sfi(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_TERMINAL_SUFI:
+ bal_get_ind__free_mem_terminal_sufi(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_TERMINAL_SUB_TERM_ACT_FAIL:
+ bal_get_ind__free_mem_terminal_sub_term_act_fail(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_TERMINAL_TIWI:
+ bal_get_ind__free_mem_terminal_tiwi(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_TM_SCHED_OPER_STATS_CHANGE:
+ bal_get_ind__free_mem_tm_sched_osc(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_PKT_DATA:
+ bal_get_ind__free_mem_u_pkt_data(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_BAL_OMCI_RESP:
+ bal_get_ind__free_mem_u_bal_omci_resp(balIndCfg);
+ break;
+
+ case BAL_INDICATIONS__U_BAL_OAM_RESP:
+ bal_get_ind__free_mem_u_bal_oam_resp(balIndCfg);
+ break;
+
+ default:
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Unknown BAL indication %u", balIndCfg->u_case);
+ break;
+ }
+}
+
+void bal_get_ind__bal_get_ind_from_device_cb(grpc_c_context_t *context)
+{
+ BalDefault *dummy;
+ BalIndications *bal_indication;
+ list_node *node = NULL;
+ int ret_val = 0;
+
+ /*
+ * Read incoming message into set_cfg
+ */
+ if (context->gcc_payload) {
+ context->gcc_stream->read(context, (void **)&dummy, 0);
+ }
+
+ /*
+ * send it to BAL
+ */
+
+ pthread_mutex_lock(&bal_ind_queue_lock);
+ node = get_bal_indication_node();
+ pthread_mutex_unlock(&bal_ind_queue_lock);
+
+ if(node != NULL)
+ {
+ bal_indication = node->bal_indication;
+ bal_indication->ind_present = true;
+ bal_indication->has_ind_present = true;
+ }
+ else
+ {
+ bal_indication = malloc(sizeof(BalIndications));
+ memset(bal_indication, 0, sizeof(BalIndications));
+ bal_indications__init(bal_indication);
+ bal_indication->ind_present = false;
+ bal_indication->has_ind_present = true;
+ }
+
+ /*
+ * Write reply back to the client
+ */
+
+ ret_val = context->gcc_stream->write(context, bal_indication, -1);
+ is_grpc_write_pending(ret_val);
+
+ grpc_c_status_t status;
+ status.gcs_code = 0;
+
+ /*
+ * Finish response for RPC
+ */
+ if (context->gcc_stream->finish(context, &status))
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Failed to write status");
+ }
+
+ /*Free memory for 'bal_indication' and 'node'*/
+ if (bal_indication->ind_present)
+ {
+ bal_get_ind__free_mem(bal_indication);
+ free(node);
+ }
+ else
+ {
+ free(bal_indication);
+ }
+}
+
+/*
+ * This functions gets invoked whenever bal finish RPC gets called
+ */
+void bal__bal_api_finish_cb(grpc_c_context_t *context)
+{
+
+}
+
+void bal_ind__bal_acc_term_oper_sts_cng_ind_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_acc_term_cfg_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_acc_term_proc_err_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_flow_oper_sts_cng_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_flow_proc_err_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_iface_oper_sts_cng_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_iface_los_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_iface_stat_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_subs_term_oper_sts_cng_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_subs_term_discovery_ind_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_subs_term_alarm_ind_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_subs_term_dgi_ind_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_subs_term_proc_err_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_subs_term_dowi_ind_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_subs_term_looci_ind_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_subs_term_sdi_ind_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_subs_term_sfi_ind_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_subs_term_sufi_ind_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_subs_term_tiwi_ind_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_sub_term_act_fail_ind_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_tm_sched_oper_stats_change_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_pkt_bearer_channel_rx_ind_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_pkt_omci_channel_rx_ind_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_pkt_ieee_oam_channel_rx_ind_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_sys_profile_ind_cb(grpc_c_context_t *context)
+{
+}
+
+/*
+** ASFVOLT_HEX2LOG(ASFVOLT_DEBUG, "OMCI Response with %zd bytes is",
+** balIndCfg.balomciresp->data->pkt.data, balIndCfg.balomciresp->data->pkt.len);
+*/
+#define SYSLOG_MAX_SIZE 1024
+void asfvolt_hexlog2(int prio, const char *_file_loc, int _file_line, const char *pFormat, void* pData, size_t len)
+{
+ unsigned char *inpPtr = pData;
+ char tempBuf[SYSLOG_MAX_SIZE];
+ size_t idx = 0;
+
+ idx += snprintf(tempBuf+idx, SYSLOG_MAX_SIZE-1, pFormat, len);
+ while (len-- > 0 && idx < SYSLOG_MAX_SIZE)
+ {
+ idx += snprintf(tempBuf+idx, SYSLOG_MAX_SIZE-idx, "%02x", *inpPtr++);
+ }
+ ASFVOLT_LOG_LOC(prio, _file_loc, _file_line, "%s", tempBuf);
+}
+
+/*
+ * Takes socket path as argument
+ */
+int main (int argc, char **argv)
+{
+ int i = 0;
+ grpc_c_server_t *server = NULL;
+
+ if (argc < 4)
+ {
+ fprintf(stderr, "Missing arguments\n");
+ exit(1);
+ }
+
+ strcpy(coreIpPortInfo.bal_core_arg1, argv[2] /*, strlen(argv[2])*/);
+ strcpy(coreIpPortInfo.bal_core_ip_port, argv[3]/*, strlen(argv[3])*/);
+
+ signal(SIGINT, sigint_handler);
+
+ /*
+ ** syslog initialization
+ */
+ //setlogmask (LOG_UPTO (LOG_NOTICE));
+
+ openlog (ASFVOLT_SYSLOG_NAME, ASFVOLT_SYSLOG_MODE, LOG_LOCAL1);
+
+ /*
+ * Initialize grpc-c library to be used with vanilla gRPC
+ */
+ grpc_c_init(GRPC_THREADS, NULL);
+
+ /*
+ * Create server object
+ */
+ test_server = grpc_c_server_create(argv[1]);
+
+ if (test_server == NULL)
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR, "Failed to create server");
+ exit(1);
+ }
+
+ /*
+ * Initialize greeter service
+ */
+ ASFVOLT_LOG(ASFVOLT_INFO, "voltha_bal_driver running.....");
+ bal__service_init(test_server);
+ bal_get_ind__service_init(test_server);
+ asfvolt__service_init(test_server);
+
+ /*
+ * Start server
+ */
+ grpc_c_server_start(test_server);
+
+ /*
+ * Blocks server to wait to completion
+ */
+ grpc_c_server_wait(test_server);
+
+ /* code added for example Makefile to compile grpc-c along with edgecore driver */
+ bal__service_init(server);
+ bal_get_ind__service_init(server);
+ asfvolt__service_init(server);
+}