Files
solver/OndselSolver/Sum.cpp
aiksiongkoh 3d6a23a678 Cmake gtest (#72)
* Check rackpin and gear for zero radii

* rebase zero-radii-check (#69)

* contributing

* Update push-freecad.yml

updated actions/checkout to v4

* dragging log for debugging

* fix calcdxNorm crash

* setDebug and remove MBDyn*

* Update cmakelists.txt

* fix includes for gcc-14

gcc-14 is more disciplined about not including <algorithm> transitively.

* fix runDragStep

* backhoe files (#65)

* Mark unused variables to silence compiler warnings. (#64)

* Backhoe issues (#67)

* backhoe issues

* runDragStep edit

* backhoe issues

* runDragStep edit

* Reduce large drag step progressively until convergence.

* Switch to using built-in M_PI, even on MSVC (#68)

---------

Co-authored-by: Brad Collette <bradcollette@pop-os.localdomain>
Co-authored-by: mosfet80 <realeandrea@yahoo.it>
Co-authored-by: PaddleStroke <pierrelouis.boyer@gmail.com>
Co-authored-by: Jed Brown <jed@jedbrown.org>
Co-authored-by: sliptonic <shopinthewoods@gmail.com>
Co-authored-by: Chris Hennes <chennes@pioneerlibrarysystem.org>

* in progress

* Gtest added

---------

Co-authored-by: Brad Collette <bradcollette@pop-os.localdomain>
Co-authored-by: mosfet80 <realeandrea@yahoo.it>
Co-authored-by: PaddleStroke <pierrelouis.boyer@gmail.com>
Co-authored-by: Jed Brown <jed@jedbrown.org>
Co-authored-by: sliptonic <shopinthewoods@gmail.com>
Co-authored-by: Chris Hennes <chennes@pioneerlibrarysystem.org>
2024-07-30 14:45:59 -06:00

184 lines
4.4 KiB
C++

/***************************************************************************
* Copyright (c) 2023 Ondsel, Inc. *
* *
* This file is part of OndselSolver. *
* *
* See LICENSE file for details about copyright. *
***************************************************************************/
#include <sstream>
#include <string>
#include "Sum.h"
#include "Constant.h"
#include <algorithm>
#include "Integral.h"
using namespace MbD;
Symsptr MbD::Sum::parseExpression(const std::string& expression)
{
std::istringstream iss(expression);
auto sum = std::make_shared<Sum>();
sum->parse(iss);
return sum->simplified(sum);
}
void MbD::Sum::parse(std::istringstream& iss)
{
iss >> std::ws;
char c = iss.peek();
if (c == '+') {
parsePlusTerm(iss);
}
else if (c == '-') {
parseMinusTerm(iss);
}
else {
parseTerm(iss);
}
}
void MbD::Sum::parseTerm(std::istringstream&)
{
}
void MbD::Sum::parsePlusTerm(std::istringstream& iss)
{
iss.get();
}
void MbD::Sum::parseMinusTerm(std::istringstream&)
{
}
Symsptr Sum::expandUntil(Symsptr sptr, std::shared_ptr<std::unordered_set<Symsptr>> set)
{
auto itr = std::find_if(set->begin(), set->end(), [sptr](Symsptr sym) {return sptr.get() == sym.get(); });
if (itr != set->end()) {
auto answer = std::make_shared<Sum>();
answer->terms = terms;
return answer;
}
auto newTerms = std::make_shared<std::vector<Symsptr>>();
for (const auto& term : *terms) {
auto newTerm = term->expandUntil(term, set);
if (newTerm->isSum()) {
newTerms->insert(newTerms->end(), newTerm->getTerms()->begin(), newTerm->getTerms()->end());
}
else {
newTerms->push_back(newTerm);
}
}
auto newSize = newTerms->size();
if (newSize == 0) {
return sptrConstant(0.0);
}
else if (newSize == 1) {
return newTerms->at(0);
}
else {
auto answer = std::make_shared<Sum>();
answer->terms = newTerms;
return answer;
}
}
Symsptr Sum::simplifyUntil(Symsptr, std::shared_ptr<std::unordered_set<Symsptr>> set)
{
auto itr = std::find_if(set->begin(), set->end(), [this](Symsptr sym) {return this == (sym.get()); });
if (itr != set->end()) {
auto answer = std::make_shared<Sum>();
answer->terms = terms;
return answer;
}
auto newTerms = std::make_shared<std::vector<Symsptr>>();
double constant = 0.0;
for (const auto& term : *terms) {
auto newTerm = term->simplifyUntil(term, set);
if (newTerm->isConstant()) {
constant += term->getValue();
}
else {
newTerms->push_back(newTerm);
}
}
if (newTerms->size() == 0 && constant == 0.0) {
return sptrConstant(0.0);
}
if (constant != 0.0) {
newTerms->insert(newTerms->begin(), sptrConstant(constant));
}
if (newTerms->size() == 1) {
return newTerms->at(0);
}
auto answer = std::make_shared<Sum>();
answer->terms = newTerms;
return answer;
}
bool Sum::isSum()
{
return true;
}
double Sum::getValue()
{
double answer = 0.0;
for (size_t i = 0; i < terms->size(); i++) answer += terms->at(i)->getValue();
return answer;
}
Symsptr MbD::Sum::clonesptr()
{
return std::make_shared<Sum>(*this);
}
Symsptr MbD::Sum::differentiateWRT(Symsptr var)
{
auto derivatives = std::make_shared<std::vector<Symsptr>>();
for (const auto& term : *terms) {
auto deriv = term->differentiateWRT(var);
derivatives->push_back(deriv);
}
auto answer = std::make_shared<Sum>();
answer->terms = derivatives;
return answer->simplified();
}
Symsptr MbD::Sum::integrateWRT(Symsptr var)
{
auto simple = simplified();
auto answer = std::make_shared<Integral>();
answer->xx = var;
answer->integrand = simple;;
if (simple->isSum()) {
auto newTerms = simple->getTerms();
auto integrals = std::make_shared<std::vector<Symsptr>>();
std::transform(newTerms->begin(),
newTerms->end(),
std::back_inserter(*integrals),
[var](Symsptr term) { return term->integrateWRT(var); }
);
auto sum = std::make_shared<Sum>();
sum->terms = integrals;
answer->expression = sum->simplified();
}
else {
answer->expression = simple->integrateWRT(var);
}
return answer;
}
std::ostream& Sum::printOn(std::ostream& s) const
{
s << "(";
s << *(this->terms->at(0));
for (size_t i = 1; i < this->terms->size(); i++)
{
s << " + " << *(this->terms->at(i));
}
s << ")";
return s;
}