First version of asfvolt16 device driver code
Change-Id: I806c2eaeebc7f8df7073c8264a7fdc6011b0d103
diff --git a/device_simulator/voltha_bal_driver.c b/device_simulator/voltha_bal_driver.c
new file mode 100755
index 0000000..92c3dd5
--- /dev/null
+++ b/device_simulator/voltha_bal_driver.c
@@ -0,0 +1,505 @@
+/*
+** 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 <unistd.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"
+
+#ifdef BAL_STUB
+#include "bal_stub.h"
+#else
+#include "asfvolt16_driver.h"
+#endif
+
+/* Global varibles */
+balCoreIpInfo coreIpPortInfo;
+
+static grpc_c_server_t *test_server;
+
+static void sigint_handler (int x) {
+ grpc_c_server_destroy(test_server);
+ exit(0);
+}
+
+/*
+ * This functions gets invoked whenever bal RPC gets called
+ */
+void bal__bal_cfg_get_cb(grpc_c_context_t *context)
+{
+ BalCfg *get_cfg;
+
+ /*
+ * Read incoming message into get_cfg
+ */
+ if (context->gcc_payload) {
+ context->gcc_stream->read(context, (void **)&get_cfg, 0);
+ }
+
+#ifndef BAL_STUB
+ //asfvolt16_bal_cfg_get(key, get_cfg);
+#endif
+}
+
+/*
+ * This functions gets invoked whenever bal RPC gets called
+ */
+void bal__bal_cfg_set_cb(grpc_c_context_t *context)
+{
+ BalCfg *set_cfg;
+ 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, 0);
+ if (ret_val != GRPC_C_WRITE_OK) {
+ if(ret_val == GRPC_C_WRITE_PENDING) {
+ printf("write is pending, sleep for 10 sec\n", ret_val);
+ sleep(10);
+ }
+ else {
+ printf("Failed to write\n", ret_val);
+ exit(1);
+ }
+ }
+
+ grpc_c_status_t status;
+ status.gcs_code = 0;
+
+ /*
+ * Finish response for RPC
+ */
+ if (context->gcc_stream->finish(context, &status)) {
+ printf("Failed to write status\n");
+ exit(1);
+ }
+
+#ifdef BAL_STUB
+ pthread_mutex_lock(&lock);
+
+ struct QNode *temp = newNode(set_cfg->hdr->obj_type,
+ BAL_ERRNO__BAL_ERR_OK,
+ set_cfg->device_id);
+
+/* if(set_cfg->hdr->has_obj_type)
+ { */
+
+ switch(set_cfg->hdr->obj_type)
+ {
+ case BAL_OBJ_ID__BAL_OBJ_ID_ACCESS_TERMINAL:
+ {
+ printf("\n***************************************************\n");
+ printf("Received Access Terminal Configuration msg\n");
+ printf("***************************************************\n");
+ }
+ break;
+ case BAL_OBJ_ID__BAL_OBJ_ID_INTERFACE:
+ {
+ printf("\n***************************************************\n");
+ printf("Received PON Interface Configuration msg\n");
+ printf("***************************************************\n");
+ temp->intf_id = set_cfg->interface->key->intf_id;
+ printf("Pon ID = %d\n", temp->intf_id);
+ }
+ break;
+ case BAL_OBJ_ID__BAL_OBJ_ID_SUBSCRIBER_TERMINAL:
+ {
+ printf("\n*****************************************************\n");
+ printf("Received ONU Activation msg\n");
+ printf("*****************************************************\n");
+ temp->intf_id = set_cfg->terminal->key->intf_id;
+ temp->onu_id = set_cfg->terminal->key->sub_term_id;
+ memset(temp->vendor_id, 0, BAL_DEVICE_STR_LEN);
+ memcpy(temp->vendor_id,
+ set_cfg->terminal->data->serial_number->vendor_id,
+ strlen(set_cfg->terminal->data->serial_number->vendor_id));
+ memset(temp->vendor_specific, 0, BAL_DEVICE_STR_LEN);
+ memcpy(temp->vendor_specific,
+ set_cfg->terminal->data->serial_number->vendor_specific,
+ strlen(set_cfg->terminal->data->serial_number->vendor_specific));
+
+ }
+ break;
+ case BAL_OBJ_ID__BAL_OBJ_ID_PACKET:
+ {
+ switch(set_cfg->packet->key->packet_send_dest->type)
+ {
+ case BAL_DEST_TYPE__BAL_DEST_TYPE_ITU_OMCI_CHANNEL:
+ {
+ printf("\n*****************************************************\n");
+ printf("Received OMCI msg\n");
+ printf("*****************************************************\n");
+ temp->intf_id = set_cfg->terminal->key->intf_id;
+ temp->onu_id = set_cfg->terminal->key->sub_term_id;
+ }
+ break;
+ default:
+ {
+ ("\n*****************************************************\n");
+ printf("Dest type invalid\n");
+ printf("*****************************************************\n");
+ }
+ break;
+ }
+ }
+ break;
+ default:
+ {
+ ("\n*****************************************************\n");
+ printf("Received Invalid msg\n");
+ printf("*****************************************************\n");
+ pthread_mutex_unlock(&lock);
+ return;
+ }
+ break;
+ }
+ enQueue(set_cfg->hdr->obj_type, temp);
+/*
+ }
+ else
+ {
+ printf("BALSTUB:Cfg Set recevied without object type");
+ } */
+ pthread_mutex_unlock(&lock);
+ sleep(2);
+ pthread_cond_signal(&cv);
+/*
+ if(BAL_OBJ_ID__BAL_OBJ_ID_INTERFACE == set_cfg->hdr->obj_type)
+ {
+ sleep(5);
+ struct QNode *temp1 = newNode(BAL_OBJ_ID__BAL_OBJ_ID_SUBSCRIBER_TERMINAL,
+ BAL_ERRNO__BAL_ERR_OK,
+ set_cfg->device_id);
+ temp1->intf_id = set_cfg->interface->key->intf_id;
+ temp1->onu_id = 65535;
+ printf("sending _onu_discovery_indiaction\n");
+ enQueue(BAL_OBJ_ID__BAL_OBJ_ID_SUBSCRIBER_TERMINAL, temp1);
+ pthread_cond_signal(&cv);
+ }
+*/
+#else
+ 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);
+#endif
+}
+
+
+/*
+ * This functions gets invoked whenever bal clear RPC gets called
+ */
+void bal__bal_cfg_clear_cb(grpc_c_context_t *context)
+{
+ BalKey *clear_key;
+
+ /*
+ * Read incoming message into clear_key
+ */
+ if (context->gcc_payload) {
+ context->gcc_stream->read(context, (void **)&clear_key, 0);
+ }
+
+#ifndef BAL_STUB
+ asfvolt16_bal_cfg_clear(clear_key);
+#endif
+}
+
+
+/*
+ * This functions gets invoked whenever bal Init RPC gets called
+ */
+void bal__bal_api_init_cb(grpc_c_context_t *context)
+{
+ BalInit *bal_init;
+ 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
+ */
+
+
+ ("\n*****************************************************\n");
+ printf("Received API Init msg\n");
+ printf("*****************************************************\n");
+
+ 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);
+ if (ret_val != GRPC_C_WRITE_OK) {
+ if(ret_val == GRPC_C_WRITE_PENDING) {
+ printf("write is pending, sleep for 10 sec\n", ret_val);
+ sleep(10);
+ }
+ else {
+ printf("Failed to write\n", ret_val);
+ exit(1);
+ }
+ }
+
+ grpc_c_status_t status;
+ status.gcs_code = 0;
+
+ /*
+ * Finish response for RPC
+ */
+ if (context->gcc_stream->finish(context, &status)) {
+ printf("Failed to write status\n");
+ exit(1);
+ }
+
+#ifndef BAL_STUB
+ asfvolt16_bal_init(bal_init, &coreIpPortInfo);
+#else
+ printf("\nRecevied IP Address == %s \n", bal_init->voltha_adapter_ip_port);
+ stub_bal_init(bal_init);
+#endif
+
+}
+
+
+/*
+ * This functions gets invoked whenever bal finish RPC gets called
+ */
+void bal__bal_api_finish_cb(grpc_c_context_t *context)
+{
+#if 0
+ void *finish_init;
+
+ /*
+ * Read incoming message into set_cfg
+ */
+ if (context->gcc_payload) {
+ context->gcc_stream->read(context, (void **)&finish_init);
+ }
+#endif
+}
+
+#if 0
+/*
+ * This functions gets invoked whenever bal finish RPC gets called
+ */
+void bal_ind__bal_ind_info_cb(grpc_c_context_t *context)
+{
+#if 0
+ void *finish_init;
+
+ /*
+ * Read incoming message into set_cfg
+ */
+ if (context->gcc_payload) {
+ context->gcc_stream->read(context, (void **)&finish_init);
+ }
+#endif
+}
+#endif
+
+void bal_ind__bal_acc_term_ind_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_flow_oper_sts_cng_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_flow_ind_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_group_ind_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_ind_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_ind_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_tm_queue_ind_info_cb(grpc_c_context_t *context)
+{
+}
+void bal_ind__bal_tm_sched_ind_info_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__bal_api_heartbeat_cb(grpc_c_context_t *context)
+{
+ BalHeartbeat *bal_hb;
+ BalErr bal_err;
+
+ /*
+ * Read incoming message into set_cfg
+ */
+ printf("\nRecevied HeartBeat from Adapter\n");
+ if (context->gcc_payload) {
+ context->gcc_stream->read(context, (void **)&bal_hb, 0);
+ }
+
+ printf("Received Heart Beat msg\n");
+
+ bal_err__init(&bal_err);
+
+ bal_err.err= 0;
+
+ /*
+ * Write reply back to the client
+ */
+ if (!context->gcc_stream->write(context, &bal_err, 0)) {
+ } else {
+ printf("Failed to write\n");
+ exit(1);
+ }
+
+ grpc_c_status_t status;
+ status.gcs_code = 0;
+
+ /*
+ * Finish response for RPC
+ */
+ if (context->gcc_stream->finish(context, &status)) {
+ printf("Failed to write status\n");
+ exit(1);
+ }
+ printf("\nSent HeartBeat Response to Adapter\n");
+}
+
+/*
+ * Takes socket path as argument
+ */
+int main (int argc, char **argv)
+{
+ int i = 0;
+ grpc_c_server_t *server = NULL;
+
+ if (argc < 6) {
+ fprintf(stderr, "Missing socket path argument\n");
+ exit(1);
+ }
+
+ strcpy(coreIpPortInfo.bal_core_arg1, argv[2] /*, strlen(argv[2])*/);
+ strcpy(coreIpPortInfo.bal_core_ip_port, argv[3]/*, strlen(argv[3])*/);
+ strcpy(coreIpPortInfo.bal_core_arg2, argv[4]/*, strlen(argv[4])*/);
+ strcpy(coreIpPortInfo.bal_shared_lib_ip_port, argv[5]/*, strlen(argv[5])*/);
+
+ signal(SIGINT, sigint_handler);
+ /*
+ * 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) {
+ printf("Failed to create server\n");
+ exit(1);
+ }
+
+ /*
+ * Initialize greeter service
+ */
+ printf("\nbal_voltha_app running.....\n");
+ bal__service_init(test_server);
+
+ /*
+ * Start server
+ */
+ grpc_c_server_start(test_server);
+
+#ifdef BAL_STUB
+ printf("\nCreating a stub thread\n");
+ create_stub_thread();
+#endif
+
+ /*
+ * 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);
+
+}