File size: 4,099 Bytes
985c397
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
/***************************************************************************
 *   Copyright (c) 2013 Jan Rheinländer                                    *
 *                                   <jrheinlaender@users.sourceforge.net> *
 *                                                                         *
 *   This file is part of the FreeCAD CAx development system.              *
 *                                                                         *
 *   This library is free software; you can redistribute it and/or         *
 *   modify it under the terms of the GNU Library General Public           *
 *   License as published by the Free Software Foundation; either          *
 *   version 2 of the License, or (at your option) any later version.      *
 *                                                                         *
 *   This library  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 Library General Public License for more details.                  *
 *                                                                         *
 *   You should have received a copy of the GNU Library General Public     *
 *   License along with this library; see the file COPYING.LIB. If not,    *
 *   write to the Free Software Foundation, Inc., 59 Temple Place,         *
 *   Suite 330, Boston, MA  02111-1307, USA                                *
 *                                                                         *
 ***************************************************************************/


#include <Precision.hxx>


#include "FemConstraintPulley.h"


using namespace Fem;

PROPERTY_SOURCE(Fem::ConstraintPulley, Fem::ConstraintGear)

ConstraintPulley::ConstraintPulley()
{
    ADD_PROPERTY(OtherDiameter, (100.0));
    ADD_PROPERTY(CenterDistance, (500.0));
    ADD_PROPERTY(IsDriven, (0));
    ADD_PROPERTY(TensionForce, (0.0));

    ADD_PROPERTY_TYPE(
        BeltAngle,
        (0),
        "ConstraintPulley",
        App::PropertyType(App::Prop_ReadOnly | App::Prop_Output),
        "Angle of belt forces"
    );
    ADD_PROPERTY_TYPE(
        BeltForce1,
        (0.0),
        "ConstraintPulley",
        App::PropertyType(App::Prop_ReadOnly | App::Prop_Output),
        "First belt force"
    );
    ADD_PROPERTY_TYPE(
        BeltForce2,
        (0.0),
        "ConstraintPulley",
        App::PropertyType(App::Prop_ReadOnly | App::Prop_Output),
        "Second belt force"
    );
    ForceAngle.setValue(0.0);
    Diameter.setValue(300.0);
    // calculate initial values of read-only properties
    onChanged(&Force);
}

App::DocumentObjectExecReturn* ConstraintPulley::execute()
{
    return ConstraintGear::execute();
}

void ConstraintPulley::onChanged(const App::Property* prop)
{
    ConstraintGear::onChanged(prop);

    if ((prop == &Diameter) || (prop == &OtherDiameter) || (prop == &CenterDistance)) {
        if (CenterDistance.getValue() > Precision::Confusion()) {
            BeltAngle.setValue(
                asin((Diameter.getValue() - OtherDiameter.getValue()) / 2 / CenterDistance.getValue())
            );
            BeltAngle.touch();
        }
    }
    else if ((prop == &Force) || (prop == &TensionForce) || (prop == &IsDriven)) {
        double radius = Diameter.getValue() / 2.0;
        if (radius < Precision::Confusion()) {
            return;
        }
        double force = Force.getValue() / (radius / 1000);
        if (fabs(force) < Precision::Confusion()) {
            return;
        }
        bool neg = (force < 0.0);
        if (neg) {
            force *= -1.0;
        }

        if (IsDriven.getValue() == neg) {
            BeltForce1.setValue(force + TensionForce.getValue());
            BeltForce2.setValue(TensionForce.getValue());
        }
        else {
            BeltForce2.setValue(force + TensionForce.getValue());
            BeltForce1.setValue(TensionForce.getValue());
        }
        BeltForce1.touch();
    }
}