prop_logic_predicate.cpp

Go to the documentation of this file.

#include <predicate_manager/prop_logic_predicate.h>

#include <ros/ros.h>

using namespace std;
using namespace predicate_manager;


PropLogicPredicate::
PropLogicPredicate ( const string& name,
                     const PropLogic& pl ) :
    Predicate ( name ),
    prop_logic_ ( pl.clone() )
{
    declareAllDependencies();
}

PropLogicPredicate::
PropLogicPredicate ( const string& name ) :
    Predicate ( name ),
    prop_logic_ ()
{}

void
PropLogicPredicate::
bindPropLogic ( const PropLogic& pl )
{
    if ( prop_logic_ != 0 )
    {
        ROS_ERROR_STREAM ( "Overwriting the Propositional Logic formula associated with predicate " << getName() );
    }
    prop_logic_ = pl.clone();
    declareAllDependencies();

    update();
}

void
PropLogicPredicate::
update()
{
    if ( prop_logic_ != 0 )
    {
        bool val = prop_logic_->evaluate ( boost::bind ( &PropLogicPredicate::evaluate,this,_1 ) );
        setValue ( val );
    }
}

void
PropLogicPredicate::
declareAllDependencies()
{
    if ( prop_logic_!=0 )
    {
        NameIDSet dep_set;
        prop_logic_->printVariables ( dep_set );
        foreach ( NameID dep_name_id, dep_set )
        {
            declareDependency ( dep_name_id );
        }
    }
}

bool
PropLogicPredicate::
evaluate ( const NameID& dep_name_id )
{
    return getDependencyValue ( dep_name_id.second, dep_name_id.first );
}