New Cam simulator based on low level OpenGL functions (faster and more precise) (#13884)
* Initial opengl test window * added core files * some fixes for code comparability with other platforms * more compatibility cleanup * add missing opengl libraries * Basic simulation window works! * try using different define * fix wrapper for better compatibility * Gui is now operational * Finally SIM works on actual freecad models * support drill commands * cleanup python script and add tool profile generation * Now using actual tools specified in the operation. * support mouse wheel and freecad-style 3d navigation * Support accuracy gauge * remove endsimulation reference * show simulation speed indicator * apply clang-format * apply changes suggested by code review * gui items are loaded via QT resource system instead of hard coded * use vector instead of pointer to pass tool profile points * Fix some more formatting errors.
This commit is contained in:
Shai Seger
234
src/Mod/CAM/PathSimulator/AppGL/GCodeParser.cpp
Normal file
234
src/Mod/CAM/PathSimulator/AppGL/GCodeParser.cpp
Normal file
@@ -0,0 +1,234 @@
|
||||
/***************************************************************************
|
||||
* Copyright (c) 2024 Shai Seger <shaise at gmail> *
|
||||
* *
|
||||
* 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 *
|
||||
* *
|
||||
***************************************************************************/
|
||||
|
||||
#ifdef _MSC_VER
|
||||
#ifndef _CRT_SECURE_NO_WARNINGS
|
||||
#define _CRT_SECURE_NO_WARNINGS
|
||||
#endif
|
||||
#endif
|
||||
|
||||
#include "GCodeParser.h"
|
||||
#include <ctype.h>
|
||||
#include <stdio.h>
|
||||
|
||||
using namespace MillSim;
|
||||
|
||||
static char TokTypes[] = "GTXYZIJKR";
|
||||
|
||||
GCodeParser::~GCodeParser()
|
||||
{
|
||||
// Clear the vector
|
||||
Operations.clear();
|
||||
}
|
||||
|
||||
bool GCodeParser::Parse(const char* filename)
|
||||
{
|
||||
Operations.clear();
|
||||
lastState = {eNop, -1, 0, 0, 0, 0, 0, 0};
|
||||
lastTool = -1;
|
||||
|
||||
FILE* fl;
|
||||
if ((fl = fopen(filename, "rt")) == nullptr) {
|
||||
return false;
|
||||
}
|
||||
|
||||
char line[120];
|
||||
|
||||
while (!feof(fl)) {
|
||||
if (fgets(line, 120, fl) != NULL) {
|
||||
AddLine(line);
|
||||
}
|
||||
}
|
||||
fclose(fl);
|
||||
return false;
|
||||
}
|
||||
|
||||
const char* GCodeParser::GetNextToken(const char* ptr, GCToken* token)
|
||||
{
|
||||
float tokval;
|
||||
token->letter = '*';
|
||||
while (*ptr != 0) {
|
||||
char letter = toupper(*ptr);
|
||||
ptr++;
|
||||
|
||||
if (letter == ' ') {
|
||||
continue;
|
||||
}
|
||||
if (letter == '(') {
|
||||
break;
|
||||
}
|
||||
|
||||
if (IsValidToken(letter)) {
|
||||
ptr = ParseFloat(ptr, &tokval);
|
||||
token->letter = letter;
|
||||
token->fval = tokval;
|
||||
token->ival = (int)(tokval + 0.5);
|
||||
break;
|
||||
}
|
||||
}
|
||||
return ptr;
|
||||
}
|
||||
|
||||
bool GCodeParser::IsValidToken(char tok)
|
||||
{
|
||||
int len = (int)strlen(TokTypes);
|
||||
for (int i = 0; i < len; i++) {
|
||||
if (tok == TokTypes[i]) {
|
||||
return true;
|
||||
}
|
||||
}
|
||||
return false;
|
||||
}
|
||||
|
||||
const char* GCodeParser::ParseFloat(const char* ptr, float* retFloat)
|
||||
{
|
||||
float decPos = 10;
|
||||
float sign = 1;
|
||||
bool decimalPointFound = false;
|
||||
float res = 0;
|
||||
while (*ptr != 0) {
|
||||
char letter = toupper(*ptr);
|
||||
ptr++;
|
||||
|
||||
if (letter == ' ') {
|
||||
continue;
|
||||
}
|
||||
|
||||
if (letter == '-') {
|
||||
sign = -1;
|
||||
}
|
||||
else if (letter == '.') {
|
||||
decimalPointFound = true;
|
||||
}
|
||||
else if (letter >= '0' && letter <= '9') {
|
||||
float digitVal = (float)(letter - '0');
|
||||
if (decimalPointFound) {
|
||||
res = res + digitVal / decPos;
|
||||
decPos *= 10;
|
||||
}
|
||||
else {
|
||||
res = res * 10 + digitVal;
|
||||
}
|
||||
}
|
||||
else {
|
||||
ptr--;
|
||||
break;
|
||||
}
|
||||
}
|
||||
*retFloat = res * sign;
|
||||
return ptr;
|
||||
}
|
||||
|
||||
bool GCodeParser::ParseLine(const char* ptr)
|
||||
{
|
||||
GCToken token;
|
||||
bool validMotion = false;
|
||||
bool exitLoop = false;
|
||||
int cmd = 0;
|
||||
while (*ptr != 0 && !exitLoop) {
|
||||
ptr = GetNextToken(ptr, &token);
|
||||
lastLastState = lastState;
|
||||
switch (token.letter) {
|
||||
case '*':
|
||||
exitLoop = true;
|
||||
break;
|
||||
|
||||
case 'G':
|
||||
cmd = token.ival;
|
||||
if (cmd == 0 || cmd == 1) {
|
||||
lastState.cmd = eMoveLiner;
|
||||
}
|
||||
else if (cmd == 2) {
|
||||
lastState.cmd = eRotateCW;
|
||||
}
|
||||
else if (cmd == 3) {
|
||||
lastState.cmd = eRotateCCW;
|
||||
}
|
||||
else if (cmd == 73 || cmd == 81 || cmd == 82 || cmd == 83) {
|
||||
lastState.cmd = eDril;
|
||||
}
|
||||
break;
|
||||
|
||||
case 'T':
|
||||
lastState.tool = token.ival;
|
||||
break;
|
||||
|
||||
case 'X':
|
||||
lastState.x = token.fval;
|
||||
validMotion = true;
|
||||
break;
|
||||
|
||||
case 'Y':
|
||||
lastState.y = token.fval;
|
||||
validMotion = true;
|
||||
break;
|
||||
|
||||
case 'Z':
|
||||
lastState.z = token.fval;
|
||||
validMotion = true;
|
||||
break;
|
||||
|
||||
case 'I':
|
||||
lastState.i = token.fval;
|
||||
break;
|
||||
|
||||
case 'J':
|
||||
lastState.j = token.fval;
|
||||
break;
|
||||
|
||||
case 'K':
|
||||
lastState.k = token.fval;
|
||||
break;
|
||||
|
||||
case 'R':
|
||||
lastState.r = token.fval;
|
||||
break;
|
||||
}
|
||||
}
|
||||
return validMotion;
|
||||
}
|
||||
|
||||
bool GCodeParser::AddLine(const char* ptr)
|
||||
{
|
||||
bool res = ParseLine(ptr);
|
||||
if (res) {
|
||||
if (lastState.cmd == eDril) {
|
||||
// split to several motions
|
||||
lastState.cmd = eMoveLiner;
|
||||
float rPlane = lastState.r;
|
||||
float finalDepth = lastState.z;
|
||||
lastState.z = rPlane;
|
||||
Operations.push_back(lastState);
|
||||
lastState.z = finalDepth;
|
||||
Operations.push_back(lastState);
|
||||
lastState.z = rPlane;
|
||||
Operations.push_back(lastState);
|
||||
// restore original state
|
||||
lastState.z = finalDepth;
|
||||
lastState.cmd = eDril;
|
||||
}
|
||||
else {
|
||||
Operations.push_back(lastState);
|
||||
}
|
||||
}
|
||||
return res;
|
||||
}
|
||||
Reference in New Issue
Block a user