cos.cpp

Go to the documentation of this file.

/*
 *    This file is part of ACADO Toolkit.
 *
 *    ACADO Toolkit -- A Toolkit for Automatic Control and Dynamic Optimization.
 *    Copyright (C) 2008-2014 by Boris Houska, Hans Joachim Ferreau,
 *    Milan Vukov, Rien Quirynen, KU Leuven.
 *    Developed within the Optimization in Engineering Center (OPTEC)
 *    under supervision of Moritz Diehl. All rights reserved.
 *
 *    ACADO Toolkit is free software; you can redistribute it and/or
 *    modify it under the terms of the GNU Lesser General Public
 *    License as published by the Free Software Foundation; either
 *    version 3 of the License, or (at your option) any later version.
 *
 *    ACADO Toolkit is distributed in the hope that it will be useful,
 *    but WITHOUT ANY WARRANTY; without even the implied warranty of
 *    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 *    Lesser General Public License for more details.
 *
 *    You should have received a copy of the GNU Lesser General Public
 *    License along with ACADO Toolkit; if not, write to the Free Software
 *    Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301  USA
 *
 */



#include <acado/utils/acado_utils.hpp>
#include <acado/symbolic_operator/symbolic_operator.hpp>


double dCos(double x){
  return -sin(x);
}


double ddCos(double x){
  return -cos(x);
}

BEGIN_NAMESPACE_ACADO


Cos::Cos():UnaryOperator(){
  cName = "cos";

  fcn = &cos;
  dfcn = &dCos;
  ddfcn = &ddCos;

  operatorName = ON_COS;

}

Cos::Cos( Operator *_argument ):UnaryOperator(_argument){
  cName = "cos";

  fcn = &cos;
  dfcn = &dCos;
  ddfcn = &ddCos;

  operatorName = ON_COS;
}


Cos::Cos( const Cos &arg ):UnaryOperator(arg){
  cName = "cos";

  fcn = &cos;
  dfcn = &dCos;
  ddfcn = &ddCos;

  operatorName = ON_COS;
}


Cos::~Cos(){

}


Cos& Cos::operator=( const Cos &arg ){

  UnaryOperator::operator=(arg);

  return *this;
}


returnValue Cos::evaluate( EvaluationBase *x ){
 
    x->Cos(*argument);
    return SUCCESSFUL_RETURN;
}


Operator* Cos::substitute( int index, const Operator *sub ){

    return new Cos( argument->substitute( index , sub ) );

}

Operator* Cos::clone() const{

    return new Cos(*this);
}

returnValue Cos::initDerivative() {

        if( initialized ) return SUCCESSFUL_RETURN;
        initialized = BT_TRUE;

        derivative = convert2TreeProjection(new Product( new DoubleConstant( -1.0 , NE_NEITHER_ONE_NOR_ZERO ), new Sin(argument->clone()) ));
        derivative2 = convert2TreeProjection(new Product( new DoubleConstant( -1.0 , NE_NEITHER_ONE_NOR_ZERO ), new Cos(argument->clone()) ));

        return argument->initDerivative();
}


CLOSE_NAMESPACE_ACADO

// end of file.