273 lines
11 KiB
C++
273 lines
11 KiB
C++
/***************************************************************************
|
|
* Copyright (c) Yorik van Havre (yorik@uncreated.net) 2014 *
|
|
* *
|
|
* 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 "PreCompiled.h"
|
|
#ifndef _PreComp_
|
|
# include <Python.h>
|
|
#endif
|
|
|
|
#include <CXX/Extensions.hxx>
|
|
#include <CXX/Objects.hxx>
|
|
|
|
#include <Base/Console.h>
|
|
#include <Base/VectorPy.h>
|
|
#include <Base/FileInfo.h>
|
|
#include <Base/Interpreter.h>
|
|
#include <App/Document.h>
|
|
#include <App/DocumentObjectPy.h>
|
|
#include <App/Application.h>
|
|
|
|
#include <Mod/Part/App/TopoShape.h>
|
|
#include <Mod/Part/App/TopoShapePy.h>
|
|
#include <TopoDS.hxx>
|
|
#include <TopoDS_Shape.hxx>
|
|
#include <TopoDS_Edge.hxx>
|
|
#include <TopoDS_Vertex.hxx>
|
|
#include <TopoDS_Iterator.hxx>
|
|
#include <TopExp_Explorer.hxx>
|
|
#include <gp_Lin.hxx>
|
|
#include <BRep_Tool.hxx>
|
|
#include <BRepAdaptor_CompCurve.hxx>
|
|
#include <BRepAdaptor_HCompCurve.hxx>
|
|
#include <Approx_Curve3d.hxx>
|
|
#include <BRepAdaptor_HCurve.hxx>
|
|
|
|
#include "CommandPy.h"
|
|
#include "PathPy.h"
|
|
#include "Path.h"
|
|
#include "FeaturePath.h"
|
|
#include "FeaturePathCompound.h"
|
|
|
|
|
|
namespace Path {
|
|
class Module : public Py::ExtensionModule<Module>
|
|
{
|
|
|
|
public:
|
|
|
|
Module() : Py::ExtensionModule<Module>("Path")
|
|
{
|
|
add_varargs_method("write",&Module::write,
|
|
"write(object,filename): Exports a given path object to a GCode file"
|
|
);
|
|
add_varargs_method("read",&Module::read,
|
|
"read(filename,[document]): Imports a GCode file into the given document"
|
|
);
|
|
add_varargs_method("show",&Module::show,
|
|
"show(path): Add the path to the active document or create one if no document exists"
|
|
);
|
|
add_varargs_method("fromShape",&Module::fromShape,
|
|
"fromShape(Shape): Returns a Path object from a Part Shape"
|
|
);
|
|
initialize("This module is the Path module."); // register with Python
|
|
}
|
|
|
|
virtual ~Module() {}
|
|
|
|
private:
|
|
|
|
Py::Object write(const Py::Tuple& args)
|
|
{
|
|
char* Name;
|
|
PyObject* pObj;
|
|
if (!PyArg_ParseTuple(args.ptr(), "Oet",&pObj,"utf-8",&Name))
|
|
throw Py::Exception();
|
|
std::string EncodedName = std::string(Name);
|
|
PyMem_Free(Name);
|
|
Base::FileInfo file(EncodedName.c_str());
|
|
|
|
if (PyObject_TypeCheck(pObj, &(App::DocumentObjectPy::Type))) {
|
|
App::DocumentObject* obj = static_cast<App::DocumentObjectPy*>(pObj)->getDocumentObjectPtr();
|
|
if (obj->getTypeId().isDerivedFrom(Base::Type::fromName("Path::Feature"))) {
|
|
const Toolpath& path = static_cast<Path::Feature*>(obj)->Path.getValue();
|
|
std::string gcode = path.toGCode();
|
|
std::ofstream ofile(EncodedName.c_str());
|
|
ofile << gcode;
|
|
ofile.close();
|
|
}
|
|
else {
|
|
throw Py::RuntimeError("The given file is not a path");
|
|
}
|
|
}
|
|
|
|
return Py::None();
|
|
}
|
|
|
|
|
|
Py::Object read(const Py::Tuple& args)
|
|
{
|
|
char* Name;
|
|
const char* DocName=0;
|
|
if (!PyArg_ParseTuple(args.ptr(), "et|s","utf-8",&Name,&DocName))
|
|
throw Py::Exception();
|
|
std::string EncodedName = std::string(Name);
|
|
PyMem_Free(Name);
|
|
|
|
Base::FileInfo file(EncodedName.c_str());
|
|
if (!file.exists())
|
|
throw Py::RuntimeError("File doesn't exist");
|
|
|
|
App::Document *pcDoc;
|
|
if (DocName)
|
|
pcDoc = App::GetApplication().getDocument(DocName);
|
|
else
|
|
pcDoc = App::GetApplication().getActiveDocument();
|
|
if (!pcDoc)
|
|
pcDoc = App::GetApplication().newDocument(DocName);
|
|
|
|
try {
|
|
// read the gcode file
|
|
std::ifstream filestr(file.filePath().c_str());
|
|
std::stringstream buffer;
|
|
buffer << filestr.rdbuf();
|
|
std::string gcode = buffer.str();
|
|
Toolpath path;
|
|
path.setFromGCode(gcode);
|
|
Path::Feature *object = static_cast<Path::Feature *>(pcDoc->addObject("Path::Feature",file.fileNamePure().c_str()));
|
|
object->Path.setValue(path);
|
|
pcDoc->recompute();
|
|
}
|
|
catch (const Base::Exception& e) {
|
|
throw Py::RuntimeError(e.what());
|
|
}
|
|
|
|
return Py::None();
|
|
}
|
|
|
|
|
|
Py::Object show(const Py::Tuple& args)
|
|
{
|
|
PyObject *pcObj;
|
|
if (!PyArg_ParseTuple(args.ptr(), "O!", &(PathPy::Type), &pcObj))
|
|
throw Py::Exception();
|
|
|
|
try {
|
|
App::Document *pcDoc = App::GetApplication().getActiveDocument();
|
|
if (!pcDoc)
|
|
pcDoc = App::GetApplication().newDocument();
|
|
PathPy* pPath = static_cast<PathPy*>(pcObj);
|
|
Path::Feature *pcFeature = (Path::Feature *)pcDoc->addObject("Path::Feature", "Path");
|
|
Path::Toolpath* pa = pPath->getToolpathPtr();
|
|
if (!pa) {
|
|
throw Py::Exception(PyExc_ReferenceError, "object doesn't reference a valid path");
|
|
}
|
|
|
|
// copy the data
|
|
pcFeature->Path.setValue(*pa);
|
|
}
|
|
catch (const Base::Exception& e) {
|
|
throw Py::RuntimeError(e.what());
|
|
}
|
|
|
|
return Py::None();
|
|
}
|
|
|
|
|
|
Py::Object fromShape(const Py::Tuple& args)
|
|
{
|
|
PyObject *pcObj;
|
|
if (!PyArg_ParseTuple(args.ptr(), "O", &pcObj))
|
|
throw Py::Exception();
|
|
TopoDS_Shape shape;
|
|
try {
|
|
if (PyObject_TypeCheck(pcObj, &(Part::TopoShapePy::Type))) {
|
|
shape = static_cast<Part::TopoShapePy*>(pcObj)->getTopoShapePtr()->getShape();
|
|
} else {
|
|
throw Py::TypeError("the given object is not a shape");
|
|
}
|
|
if (!shape.IsNull()) {
|
|
if (shape.ShapeType() == TopAbs_WIRE) {
|
|
Path::Toolpath result;
|
|
bool first = true;
|
|
Base::Placement last;
|
|
|
|
TopExp_Explorer ExpEdges (shape,TopAbs_EDGE);
|
|
while (ExpEdges.More()) {
|
|
const TopoDS_Edge& edge = TopoDS::Edge(ExpEdges.Current());
|
|
TopExp_Explorer ExpVerts(edge,TopAbs_VERTEX);
|
|
bool vfirst = true;
|
|
while (ExpVerts.More()) {
|
|
const TopoDS_Vertex& vert = TopoDS::Vertex(ExpVerts.Current());
|
|
gp_Pnt pnt = BRep_Tool::Pnt(vert);
|
|
Base::Placement tpl;
|
|
tpl.setPosition(Base::Vector3d(pnt.X(),pnt.Y(),pnt.Z()));
|
|
if (first) {
|
|
// add first point as a G0 move
|
|
Path::Command cmd;
|
|
std::ostringstream ctxt;
|
|
ctxt << "G0 X" << tpl.getPosition().x << " Y" << tpl.getPosition().y << " Z" << tpl.getPosition().z;
|
|
cmd.setFromGCode(ctxt.str());
|
|
result.addCommand(cmd);
|
|
first = false;
|
|
vfirst = false;
|
|
} else {
|
|
if (vfirst)
|
|
vfirst = false;
|
|
else {
|
|
Path::Command cmd;
|
|
cmd.setFromPlacement(tpl);
|
|
|
|
// write arc data if needed
|
|
BRepAdaptor_Curve adapt(edge);
|
|
if (adapt.GetType() == GeomAbs_Circle) {
|
|
gp_Circ circ = adapt.Circle();
|
|
gp_Pnt c = circ.Location();
|
|
bool clockwise = false;
|
|
gp_Dir n = circ.Axis().Direction();
|
|
if (n.Z() < 0)
|
|
clockwise = true;
|
|
Base::Vector3d center = Base::Vector3d(c.X(),c.Y(),c.Z());
|
|
// center coords must be relative to last point
|
|
center -= last.getPosition();
|
|
cmd.setCenter(center,clockwise);
|
|
}
|
|
result.addCommand(cmd);
|
|
}
|
|
}
|
|
ExpVerts.Next();
|
|
last = tpl;
|
|
}
|
|
ExpEdges.Next();
|
|
}
|
|
return Py::asObject(new PathPy(new Path::Toolpath(result)));
|
|
} else {
|
|
throw Py::TypeError("the given shape must be a wire");
|
|
}
|
|
} else {
|
|
throw Py::TypeError("the given shape is empty");
|
|
}
|
|
}
|
|
catch (const Base::Exception& e) {
|
|
throw Py::RuntimeError(e.what());
|
|
}
|
|
}
|
|
|
|
};
|
|
|
|
PyObject* initModule()
|
|
{
|
|
return (new Module)->module().ptr();
|
|
}
|
|
|
|
} // namespace Path
|