-
Notifications
You must be signed in to change notification settings - Fork 299
/
SphereLoader.cpp
117 lines (94 loc) · 4.08 KB
/
SphereLoader.cpp
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
112
/******************************************************************************
* SOFA, Simulation Open-Framework Architecture *
* (c) 2006 INRIA, USTL, UJF, CNRS, MGH *
* *
* This program 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 2.1 of the License, or (at *
* your option) any later version. *
* *
* This program 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 this program. If not, see <http://www.gnu.org/licenses/>. *
*******************************************************************************
* Authors: The SOFA Team and external contributors (see Authors.txt) *
* *
* Contact information: contact@sofa-framework.org *
******************************************************************************/
#include <sofa/helper/io/SphereLoader.h>
#include <sofa/helper/system/FileRepository.h>
#include <sofa/helper/system/Locale.h>
#include <sofa/helper/logging/Messaging.h>
#include <cstdio>
#include <iostream>
#include <string>
#include <sstream>
/// This allow MeshTrian to interact with the messaging system.
MSG_REGISTER_CLASS(sofa::helper::io::SphereLoader, "SphereLoader")
namespace sofa::helper::io
{
static void skipToEOL(FILE* f)
{
int ch;
while ((ch = fgetc(f)) != EOF && ch != '\n') ;
}
bool SphereLoader::Load(const std::string& filename, SphereLoaderDataHook& data)
{
/// Make sure that fscanf() uses a dot '.' as the decimal separator.
helper::system::TemporaryLocale locale(LC_NUMERIC, "C");
std::string fname = filename;
if (!sofa::helper::system::DataRepository.findFile(fname)) return false;
char cmd[64];
FILE* file;
static const char* SPH_FORMAT = "sph 1.0";
if ((file = fopen(fname.c_str(), "r")) == nullptr)
{
msg_error("SphereLoader") << "ERROR: cannot read file '" << filename << "'. (Aborting)";
return false;
}
int totalNumSpheres=0;
/// Check first line
if (fgets(cmd, 7, file) == nullptr || !strcmp(cmd,SPH_FORMAT))
{
fclose(file);
return false;
}
skipToEOL(file);
std::ostringstream cmdScanFormat;
cmdScanFormat << "%" << (sizeof(cmd) - 1) << "s";
while (fscanf(file,cmdScanFormat.str().c_str(), cmd) != EOF)
{
if (!strcmp(cmd,"nums"))
{
if (fscanf(file, "%d", &totalNumSpheres) == EOF)
msg_error("SphereLoader") << "fscanf function has encountered an error." ;
data.setNumSpheres(totalNumSpheres);
}
else if (!strcmp(cmd,"sphe"))
{
int index;
double cx=0,cy=0,cz=0,r=1;
if (fscanf(file, "%d %lf %lf %lf %lf\n",
&index, &cx, &cy, &cz, &r) == EOF)
msg_error("SphereLoader") << "fscanf function has encountered an error." ;
data.addSphere((SReal)cx,(SReal)cy,(SReal)cz,(SReal)r);
++totalNumSpheres;
}
else if (cmd[0]=='#')
{
skipToEOL(file);
}
else // it's an unknown keyword
{
msg_info("SphereLoader") << "'"<< filename << "' unknown Sphere keyword: " << cmd ;
skipToEOL(file);
}
}
(void) fclose(file);
return true;
}
} // namespace sofa::helper::io