node_1d.cpp

Go to the documentation of this file.

/*
 * node.cpp
 *
 *  Created on: July 24, 2012
 *      Author: Berk Calli
 *      Organization: Delft Biorobotics Lab., Delft University of Technology
 *              Contact info: b.calli@tudelft.nl, web: www.dbl.tudelft.nl
 *
 *      Node for neural network extremum seeking control
 */

#include <esc_nn/nn_esc_1d.h>
#include "esc_ros/esc_ros.h"

int main(int argc, char **argv) {

        ros::init(argc, argv, "nn_esc_1d");
        ros::NodeHandle n("~");

        double A, B, M, ddelta, delta, period,stoping_min_val;
        int stopping_cycle_number;
        if (!n.getParam("A", A)){
                ROS_WARN("[nn_esc_1D]: Failed to get the parameter A from the parameter server. Using the default value.");
                A = 0;
        }
        if (!n.getParam("B", B)){
                ROS_WARN("[nn_esc_1D]: Failed to get the parameter B from the parameter server. Using the default value.");
                B = 0;
        }
        if (!n.getParam("M", M)){
                ROS_WARN("[nn_esc_1D]: Failed to get the parameter M from the parameter server. Using the default value.");
                M = 0;
        }
        if (!n.getParam("ddelta", ddelta)){
                ROS_WARN("[nn_esc_1D]: Failed to get the parameter ddelta from the parameter server. Using the default value.");
                ddelta = 0;
        }
        if (!n.getParam("delta", delta)){
                ROS_WARN("[nn_esc_1D]: Failed to get the parameter delta from the parameter server. Using the default value.");
                delta = 0;
        }

        if (!n.getParam("period", period)){
                ROS_WARN("[nn_esc_1D]: Failed to get the parameter period from the parameter server. Using the default value.");
                period = 0;
        }

        if (!n.getParam("stopping_condition/cycle_number", stopping_cycle_number)){
                ROS_WARN("[nn_esc_1D]: Failed to get the parameter stopping_condition/cycle_number from the parameter server. Using the default value.");
                stopping_cycle_number = 0;
        }

        if (!n.getParam("stopping_condition/min_val_change_per_cycle", stoping_min_val)){
                ROS_WARN("[nn_esc_1D]: Failed to get the parameter stopping_condition/min_val_change_per_cycle from the parameter server. Using the default value.");
                stoping_min_val = 0;
        }

        ESCROS esc_ros(&n);
        NNESC1D* nn_esc_1d = new NNESC1D(A,M,B,ddelta,delta,period,stopping_cycle_number,stoping_min_val);
        esc_ros.init(nn_esc_1d);
        esc_ros.spin();

        return 0;
}