Newer
Older
####################################################################################################
#
# Copyright (C) 2018 Fabrice Salvaire
#
# This program is free software: you can redistribute it and/or modify
# it under the terms of the GNU General Public License as published by
# the Free Software Foundation, either version 3 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 General Public License for more details.
#
# You should have received a copy of the GNU General Public License
# along with this program. If not, see <http://www.gnu.org/licenses/>.
#
####################################################################################################
"""Module to implement an AST for RS-274 G-code.
"""
####################################################################################################
__all__ = [
'Program',
'ParameterMixin',
'ParameterSetting',
'Parameter',
'AbsoluteValue',
'ArcCosine',
'ArcSine',
'ArcTangent',
'Cosine',
'ERaisedTo',
'FixDown',
'FixUp',
'NaturalLogOf',
'Round',
'Sine',
'SquareRoot',
'Tangent',
]
####################################################################################################
import math
####################################################################################################
class Program:
"""Class to implement a G-code program
Usage::
program = Program()
program += line
# Array interface
for line in programs:
print(line)
"""
##############################################
def __init__(self):
self._lines = []
##############################################
def clone(self):
program = self.__class__()
for line in self:
program += line.clone()
return program
##############################################
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
def push(self, line):
self._lines.append(line)
def __iadd__(self, item):
self.push(item)
return self
##############################################
def __len__(self):
return len(self._lines)
def __iter__(self):
return iter(self._lines)
def __getitem__(self, _slice):
return self._lines[_slice]
def iter_on_not_deleted(self):
for line in self._lines:
if line:
yield line
##############################################
def __repr__(self):
text = 'Program(\n'
for line in self:
text += repr(line) + '\n'
text += ')\n'
return text
##############################################
def __str__(self):
return '\n'.join(map(str, self))
####################################################################################################
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
class CloneMixin:
@staticmethod
def _clone_value(value):
if hasattr(value, 'clone'):
return value.clone()
else:
return value
####################################################################################################
class LineItem(CloneMixin):
##############################################
def _check_value(self, value):
if (isinstance(value, (int, float)) or
isinstance(value, RealValue)):
return value
else:
try:
str_value = str(value)
except:
raise ValueError("Invalid value {}".format(value))
# Fixme:
from .Parser import GcodeParser, GcodeParserError
parser = GcodeParser()
try:
# Fixme: parser hack
ast = parser.parse('X' + value)
return ast[0].value
except GcodeParserError:
raise ValueError("Invalid G-code value {}".format(value))
##############################################
####################################################################################################
class Line:
"""Class to implement a G-code line
Usage::
line = Line(deleted=False, line_number=1, comment='a comment')
line.deleted = True
print(line.deleted)
# same apply for line_number and comment
# Is line not deleted ?
bool(line)
# Push some items
# Note: order doesn't matter, see RS-274 for details
line += Word('G', 0)
line += Comment('move')
line += Word('X', 10)
line += Comment('Y value')
line += Word('Z', Addition(30, Multiply(Parameter(100), Cosine(30))))
# string way
line += Word('Z', '[30 + [#100 * cos[30]]]')
# Array interface
for item in line:
print(item)
print(line.ansi_str()) # use ANSI colors, see Line.ANSI_... attributes
a_line = line.clone()
Values can be passed as:
* int or float,
* AST for expression,
* any object that "str" evaluate to a valid G-code expression.
As a shortcut, a G/M-code operation can be passed as string::
line += 'G0'
Expression can be evaluated using :code:`float(obj.value)`, excepted when we must access a parameter
value.
ANSI_DELETED = colors.red
ANSI_LINE_NUMBER = colors.blue
ANSI_COMMENT = colors.green
ANSI_SETTING = colors.blue
ANSI_G = colors.red
ANSI_X = colors.blue
ANSI_VALUE = colors.black
##############################################
def __init__(self, deleted=False, line_number=None, comment=None):
self.deleted = deleted
self.line_number = line_number
self.comment = comment
self._items = []
##############################################
def clone(self):
line = self.__class__(self._deleted, self._line_number, self._comment)
for item in self:
line += item.clone()
return line
##############################################
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
@property
def deleted(self):
return self._deleted
@deleted.setter
def deleted(self, value):
self._deleted = bool(value)
@property
def line_number(self):
return self._line_number
@line_number.setter
def line_number(self, value):
if value is not None:
value = float(value)
if value.is_integer():
value = int(value)
self._line_number = value
@property
def comment(self):
return self._comment
@comment.setter
def comment(self, value):
if value is not None:
self._comment = str(value)
else:
self._comment = None
##############################################
def _push_item(self, item):
if not isinstance(item, LineItem):
item = Word.from_str(item)
# Fixme: try to parse ???
self._items.append(item)
def push_items(self, iterable):
"""Method to push an iterable"""
for item in iterable:
self.push(item)
"""Method to push a valid item, a 'G/Mxxx' shortcut string, a list or tuple"""
if isinstance(item, (list, tuple, Line)):
self.push_items(item)
self.push(item)
return self
##############################################
def __bool__(self):
return not self._deleted
##############################################
def __len__(self):
return len(self._items)
def __iter__(self):
return iter(self._items)
def __getitem__(self, _slice):
return self._items[_slice]
##############################################
def iter_on_word(self):
for item in self:
if isinstance(item, Word):
yield item
def iter_on_setting(self):
for item in self:
if isinstance(item, ParameterSetting):
yield item
##############################################
def toggle(self):
"""Toggle deleted flag"""
self._deleted = not self._deleted
def remove_line_number(self):
self._line_number = None
##############################################
def remove_comment(self):
self._comment = None
for i, item in enumerate(self):
if isinstance(item, Comment):
# self._items.pop(i)
del self._items[i]
##############################################
def __repr__(self):
items = []
if not self:
items.append('Deleted')
items += list(map(repr, self))
if self._comment:
items.append(self._comment)
return 'Line{}'.format(self, items)
##############################################
def __str__(self):
line = ''
if not self:
if self._line_number:
line += 'N{} '.format(self._line_number)
line += ' '.join(map(str, self))
if self._comment:
line += ' ; ' + self._comment
return line
##############################################
def ansi_str(self):
line = ''
if not self:
# line += self.ANSI_DELETED('/ ')
return self.ANSI_DELETED(str(self))
if self._line_number:
line += self.ANSI_LINE_NUMBER('N{} '.format(self._line_number))
line += ' '.join([item.ansi_str() for item in self])
if self._comment:
line += ' ' + self.ANSI_COMMENT('; ' + self._comment)
return line
####################################################################################################
class Comment(LineItem):
##############################################
def __init__(self, text):
self.set(text)
##############################################
def clone(self):
return self.__class__(self._text)
##############################################
def set(self, text):
if '(' in text:
raise ValueError('Comment cannot contains a "("')
self._text = str(text)
##############################################
@property
def text(self):
return self._text
@text.setter
def text(self, value):
self.set(value)
##############################################
def __repr__(self):
return 'Comment({0._text})'.format(self)
def __str__(self):
return '({0._text})'.format(self)
def ansi_str(self):
return Line.ANSI_COMMENT(str(self))
####################################################################################################
class Word(LineItem):
LETTERS = (
'A', 'B', 'C', 'D',
'F', 'G', 'H', 'I', 'J', 'K', 'L', 'M', # 'N',
'P', 'Q', 'R', 'S', 'T',
'X', 'Y', 'Z',
)
WORD_RE = re.compile('(G|M)(\d+)')
##############################################
@classmethod
def from_str(cls, obj):
str_obj = str(obj)
match = cls.WORD_RE.match(str_obj)
if match is not None:
return cls(*match.groups())
else:
raise ValueError(obj)
##############################################
def __init__(self, letter, value):
self.letter = letter
self.value = value
##############################################
def clone(self):
return self.__class__(self._letter, self._clone_value(self._value))
##############################################
@property
def letter(self):
return self._letter
@letter.setter
def letter(self, value):
value = str(value).upper()
if value not in self.LETTERS:
raise ValueError
self._letter = value
@property
def value(self):
return self._value
@value.setter
def value(self, value):
##############################################
def __repr__(self):
return 'Word({0._letter}, {0._value})'.format(self)
def __str__(self):
return '{0._letter}{0._value}'.format(self)
def ansi_str(self):
if self._letter in 'GM':
return Line.ANSI_G(str(self))
else:
return Line.ANSI_X(self._letter) + Line.ANSI_VALUE(str(self._value))
####################################################################################################
pass
####################################################################################################
class ParameterMixin:
##############################################
def __init__(self, parameter):
self.parameter = parameter
##############################################
def clone(self):
return self.__class__(self._parameter)
##############################################
@property
def parameter(self):
return self._parameter
@parameter.setter
def parameter(self, value):
try:
value = int(value)
except ValueError:
value = str(value)
self._parameter = value
####################################################################################################
class ParameterSetting(LineItem, ParameterMixin):
##############################################
def __init__(self, parameter, value):
ParameterMixin.__init__(self, parameter)
self.value = value
##############################################
def clone(self):
return self.__class__(self._parameter, self._clone_value(self._value))
##############################################
@property
def value(self):
return self._value
@value.setter
def value(self, value):
##############################################
def __repr__(self):
return 'ParameterSetting({0._parameter} = {0._value})'.format(self)
def __str__(self):
return '#{0._parameter}={0._value}'.format(self)
def ansi_str(self):
return Line.ANSI_SETTING('#{0._parameter}='.format(self)) + Line.ANSI_VALUE(str(self._value))
####################################################################################################
class Parameter(RealValue, ParameterMixin):
##############################################
def __init__(self, parameter):
ParameterMixin.__init__(self, parameter)
##############################################
def __repr__(self):
return 'Parameter({0._parameter})'.format(self)
def __str__(self):
return '#{0._parameter}'.format(self)
##############################################
def __float__(self):
raise NotImplementedError
####################################################################################################
class UnaryOperation(RealValue):
__function__ = None
__gcode__ = None
##############################################
def __init__(self, arg):
self.arg = arg
##############################################
def clone(self):
return self.__class__(self._clone_value(self._arg))
##############################################
@property
def arg(self):
return self._arg
@arg.setter
def arg(self, value):
self._arg = value
##############################################
return self.__function__(float(self._arg))
##############################################
def __repr__(self):
return '{}({})'.format(self.__class__.__name__, repr(self._arg))
##############################################
def __str__(self):
return '{0.__gcode__}[{0._arg}]'.format(self)
####################################################################################################
class AbsoluteValue(UnaryOperation):
__gcode__ = 'abs'
class ArcCosine(UnaryOperation):
__function__ = staticmethod(lambda x: math.acos(math.radians(x)))
__gcode__ = 'acos'
class ArcSine(UnaryOperation):
__function__ = staticmethod(lambda x: math.degrees(math.asin(x)))
__gcode__ = 'asin'
class ArcTangent(UnaryOperation):
__function__ = staticmethod(lambda x: math.degrees(math.atan(x)))
__gcode__ = 'atan'
class Cosine(UnaryOperation):
__function__ = staticmethod(lambda x: math.cos(math.radians(x)))
__gcode__ = 'cos'
class ERaisedTo(UnaryOperation):
__gcode__ = 'exp'
class FixDown(UnaryOperation):
__gcode__ = 'fix'
class FixUp(UnaryOperation):
__gcode__ = 'fup'
class NaturalLogOf(UnaryOperation):
__gcode__ = 'ln'
class Round(UnaryOperation):
__gcode__ = 'round'
class Sine(UnaryOperation):
__function__ = staticmethod(lambda x: math.sin(math.radians(x)))
__gcode__ = 'sin'
class SquareRoot(UnaryOperation):
__gcode__ = 'sqrt'
class Tangent(UnaryOperation):
__function__ = staticmethod(lambda x: ath.tan(math.radians(x)))
__gcode__ = 'tan'
####################################################################################################
class BinaryOperation(RealValue):
__function__ = None
__gcode__ = None
##############################################
def __init__(self, arg1, arg2):
self.arg1 = arg1
self.arg2 = arg2
##############################################
def clone(self):
return self.__class__(self._clone_value(self._arg1), self._clone_value(self.arg2))
##############################################
@property
def arg1(self):
return self._arg1
@arg1.setter
def arg1(self, value):
self._arg1 = value
@property
def arg2(self):
return self._arg2
@arg2.setter
def arg2(self, value):
self._arg2 = value
##############################################
return self.__function__(float(self._arg1), float(self._arg2))
##############################################
def __repr__(self):
return '{}({})'.format(self.__class__.__name__, repr(self._arg))
##############################################
def __str__(self):
return '[{0._arg1} {0.__gcode__} {0._arg2}]'.format(self)
####################################################################################################
class Power(BinaryOperation):
__gcode__ = '**'
class DividedBy(BinaryOperation):
__gcode__ = '/'
class Modulo(BinaryOperation):
__gcode__ = 'and'
class ExclusiveOr(BinaryOperation):
class Subtraction(BinaryOperation):
__function__ = staticmethod(lambda a, b: a - b)
class Or(BinaryOperation):
__function__ = staticmethod(lambda a, b: a | b)
class Addition(BinaryOperation):
__function__ = staticmethod(lambda a, b: a + b)