| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  | # Parse gcode commands | 
					
						
							|  |  |  | # | 
					
						
							| 
									
										
										
										
											2020-04-22 12:40:32 -04:00
										 |  |  | # Copyright (C) 2016-2020  Kevin O'Connor <kevin@koconnor.net> | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  | # | 
					
						
							|  |  |  | # This file may be distributed under the terms of the GNU GPLv3 license. | 
					
						
							| 
									
										
										
										
											2019-01-02 14:45:35 -08:00
										 |  |  | import os, re, logging, collections, shlex | 
					
						
							| 
									
										
										
										
											2019-11-13 11:02:26 -05:00
										 |  |  | import homing | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-04-22 12:40:32 -04:00
										 |  |  | class GCodeCommand: | 
					
						
							|  |  |  |     error = homing.CommandError | 
					
						
							| 
									
										
										
										
											2020-04-25 15:30:24 -04:00
										 |  |  |     def __init__(self, gcode, command, commandline, params, need_ack): | 
					
						
							| 
									
										
										
										
											2020-04-22 12:40:32 -04:00
										 |  |  |         self._command = command | 
					
						
							|  |  |  |         self._commandline = commandline | 
					
						
							|  |  |  |         self._params = params | 
					
						
							| 
									
										
										
										
											2020-04-25 15:30:24 -04:00
										 |  |  |         self._need_ack = need_ack | 
					
						
							| 
									
										
										
										
											2020-04-22 12:40:32 -04:00
										 |  |  |         # Method wrappers | 
					
						
							|  |  |  |         self.respond_info = gcode.respond_info | 
					
						
							|  |  |  |         self.respond_raw = gcode.respond_raw | 
					
						
							|  |  |  |     def get_command(self): | 
					
						
							|  |  |  |         return self._command | 
					
						
							|  |  |  |     def get_commandline(self): | 
					
						
							|  |  |  |         return self._commandline | 
					
						
							|  |  |  |     def get_command_parameters(self): | 
					
						
							|  |  |  |         return self._params | 
					
						
							| 
									
										
										
										
											2020-04-25 15:30:24 -04:00
										 |  |  |     def ack(self, msg=None): | 
					
						
							|  |  |  |         if not self._need_ack: | 
					
						
							|  |  |  |             return False | 
					
						
							|  |  |  |         ok_msg = "ok" | 
					
						
							|  |  |  |         if msg: | 
					
						
							|  |  |  |             ok_msg = "ok %s" % (msg,) | 
					
						
							|  |  |  |         self.respond_raw(ok_msg) | 
					
						
							|  |  |  |         self._need_ack = False | 
					
						
							|  |  |  |         return True | 
					
						
							| 
									
										
										
										
											2020-04-22 12:40:32 -04:00
										 |  |  |     # Parameter parsing helpers | 
					
						
							|  |  |  |     class sentinel: pass | 
					
						
							|  |  |  |     def get(self, name, default=sentinel, parser=str, minval=None, maxval=None, | 
					
						
							|  |  |  |             above=None, below=None): | 
					
						
							|  |  |  |         value = self._params.get(name) | 
					
						
							|  |  |  |         if value is None: | 
					
						
							|  |  |  |             if default is self.sentinel: | 
					
						
							|  |  |  |                 raise self.error("Error on '%s': missing %s" | 
					
						
							|  |  |  |                                  % (self._commandline, name)) | 
					
						
							|  |  |  |             return default | 
					
						
							|  |  |  |         try: | 
					
						
							|  |  |  |             value = parser(value) | 
					
						
							|  |  |  |         except: | 
					
						
							|  |  |  |             raise self.error("Error on '%s': unable to parse %s" | 
					
						
							|  |  |  |                              % (self._commandline, value)) | 
					
						
							|  |  |  |         if minval is not None and value < minval: | 
					
						
							|  |  |  |             raise self.error("Error on '%s': %s must have minimum of %s" | 
					
						
							|  |  |  |                              % (self._commandline, name, minval)) | 
					
						
							|  |  |  |         if maxval is not None and value > maxval: | 
					
						
							|  |  |  |             raise self.error("Error on '%s': %s must have maximum of %s" | 
					
						
							|  |  |  |                              % (self._commandline, name, maxval)) | 
					
						
							|  |  |  |         if above is not None and value <= above: | 
					
						
							|  |  |  |             raise self.error("Error on '%s': %s must be above %s" | 
					
						
							|  |  |  |                              % (self._commandline, name, above)) | 
					
						
							|  |  |  |         if below is not None and value >= below: | 
					
						
							|  |  |  |             raise self.error("Error on '%s': %s must be below %s" | 
					
						
							|  |  |  |                              % (self._commandline, name, below)) | 
					
						
							|  |  |  |         return value | 
					
						
							|  |  |  |     def get_int(self, name, default=sentinel, minval=None, maxval=None): | 
					
						
							|  |  |  |         return self.get(name, default, parser=int, minval=minval, maxval=maxval) | 
					
						
							|  |  |  |     def get_float(self, name, default=sentinel, minval=None, maxval=None, | 
					
						
							|  |  |  |                   above=None, below=None): | 
					
						
							|  |  |  |         return self.get(name, default, parser=float, minval=minval, | 
					
						
							|  |  |  |                         maxval=maxval, above=above, below=below) | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2017-12-03 19:30:49 -05:00
										 |  |  | # Parse and handle G-Code commands | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  | class GCodeParser: | 
					
						
							| 
									
										
										
										
											2019-06-03 12:48:35 -04:00
										 |  |  |     error = homing.CommandError | 
					
						
							| 
									
										
										
										
											2020-08-04 15:47:25 -04:00
										 |  |  |     def __init__(self, printer): | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  |         self.printer = printer | 
					
						
							| 
									
										
										
										
											2020-08-04 16:32:19 -04:00
										 |  |  |         self.is_fileinput = not not printer.get_start_args().get("debuginput") | 
					
						
							| 
									
										
										
										
											2019-05-24 18:45:18 -04:00
										 |  |  |         printer.register_event_handler("klippy:ready", self._handle_ready) | 
					
						
							|  |  |  |         printer.register_event_handler("klippy:shutdown", self._handle_shutdown) | 
					
						
							| 
									
										
										
										
											2019-01-08 10:58:35 -05:00
										 |  |  |         printer.register_event_handler("klippy:disconnect", | 
					
						
							| 
									
										
										
										
											2019-05-24 18:45:18 -04:00
										 |  |  |                                        self._handle_disconnect) | 
					
						
							| 
									
										
										
										
											2019-11-24 19:43:50 -05:00
										 |  |  |         printer.register_event_handler("extruder:activate_extruder", | 
					
						
							|  |  |  |                                        self._handle_activate_extruder) | 
					
						
							| 
									
										
										
										
											2020-06-19 06:25:02 -04:00
										 |  |  |         # Register webhooks | 
					
						
							|  |  |  |         webhooks = self.printer.lookup_object('webhooks') | 
					
						
							|  |  |  |         webhooks.register_endpoint( | 
					
						
							|  |  |  |             "gcode/help", self._handle_remote_help) | 
					
						
							|  |  |  |         webhooks.register_endpoint( | 
					
						
							|  |  |  |             "gcode/script", self._handle_remote_script) | 
					
						
							|  |  |  |         webhooks.register_endpoint( | 
					
						
							|  |  |  |             "gcode/restart", self._handle_remote_restart) | 
					
						
							|  |  |  |         webhooks.register_endpoint( | 
					
						
							|  |  |  |             "gcode/firmware_restart", self._handle_remote_restart) | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  |         # Command handling | 
					
						
							| 
									
										
										
										
											2016-11-22 19:38:51 -05:00
										 |  |  |         self.is_printer_ready = False | 
					
						
							| 
									
										
										
										
											2020-08-04 16:32:19 -04:00
										 |  |  |         self.mutex = printer.get_reactor().mutex() | 
					
						
							| 
									
										
										
										
											2020-08-04 14:45:21 -04:00
										 |  |  |         self.output_callbacks = [] | 
					
						
							| 
									
										
										
										
											2017-12-03 18:53:42 -05:00
										 |  |  |         self.base_gcode_handlers = self.gcode_handlers = {} | 
					
						
							|  |  |  |         self.ready_gcode_handlers = {} | 
					
						
							| 
									
										
										
										
											2018-05-20 12:33:43 -04:00
										 |  |  |         self.mux_commands = {} | 
					
						
							| 
									
										
										
										
											2017-12-03 18:53:42 -05:00
										 |  |  |         self.gcode_help = {} | 
					
						
							|  |  |  |         for cmd in self.all_handlers: | 
					
						
							|  |  |  |             func = getattr(self, 'cmd_' + cmd) | 
					
						
							|  |  |  |             wnr = getattr(self, 'cmd_' + cmd + '_when_not_ready', False) | 
					
						
							|  |  |  |             desc = getattr(self, 'cmd_' + cmd + '_help', None) | 
					
						
							|  |  |  |             self.register_command(cmd, func, wnr, desc) | 
					
						
							|  |  |  |             for a in getattr(self, 'cmd_' + cmd + '_aliases', []): | 
					
						
							|  |  |  |                 self.register_command(a, func, wnr) | 
					
						
							| 
									
										
										
										
											2017-12-21 20:45:07 -05:00
										 |  |  |         # G-Code coordinate manipulation | 
					
						
							| 
									
										
										
										
											2019-05-26 20:59:44 -04:00
										 |  |  |         self.absolute_coord = self.absolute_extrude = True | 
					
						
							| 
									
										
										
										
											2017-12-21 20:45:07 -05:00
										 |  |  |         self.base_position = [0.0, 0.0, 0.0, 0.0] | 
					
						
							|  |  |  |         self.last_position = [0.0, 0.0, 0.0, 0.0] | 
					
						
							| 
									
										
										
										
											2018-04-20 19:42:26 -04:00
										 |  |  |         self.homing_position = [0.0, 0.0, 0.0, 0.0] | 
					
						
							| 
									
										
										
										
											2019-05-24 19:37:08 -04:00
										 |  |  |         self.speed = 25. | 
					
						
							| 
									
										
										
										
											2017-12-21 20:53:44 -05:00
										 |  |  |         self.speed_factor = 1. / 60. | 
					
						
							| 
									
										
										
										
											2017-12-21 21:33:38 -05:00
										 |  |  |         self.extrude_factor = 1. | 
					
						
							| 
									
										
										
										
											2019-05-26 11:08:48 -04:00
										 |  |  |         # G-Code state | 
					
						
							|  |  |  |         self.saved_states = {} | 
					
						
							| 
									
										
										
										
											2018-01-20 23:47:36 -05:00
										 |  |  |         self.move_transform = self.move_with_transform = None | 
					
						
							|  |  |  |         self.position_with_transform = (lambda: [0., 0., 0., 0.]) | 
					
						
							| 
									
										
										
										
											2019-11-13 11:29:27 -05:00
										 |  |  |         self.toolhead = None | 
					
						
							| 
									
										
										
										
											2020-01-07 19:06:55 -05:00
										 |  |  |     def is_traditional_gcode(self, cmd): | 
					
						
							|  |  |  |         # A "traditional" g-code command is a letter and followed by a number | 
					
						
							|  |  |  |         try: | 
					
						
							|  |  |  |             cmd = cmd.upper().split()[0] | 
					
						
							|  |  |  |             val = float(cmd[1:]) | 
					
						
							|  |  |  |             return cmd[0].isupper() and cmd[1].isdigit() | 
					
						
							|  |  |  |         except: | 
					
						
							|  |  |  |             return False | 
					
						
							| 
									
										
										
										
											2017-12-03 18:53:42 -05:00
										 |  |  |     def register_command(self, cmd, func, when_not_ready=False, desc=None): | 
					
						
							| 
									
										
										
										
											2018-01-17 11:26:09 -05:00
										 |  |  |         if func is None: | 
					
						
							| 
									
										
										
										
											2020-02-12 20:19:18 -05:00
										 |  |  |             old_cmd = self.ready_gcode_handlers.get(cmd) | 
					
						
							| 
									
										
										
										
											2018-01-17 11:26:09 -05:00
										 |  |  |             if cmd in self.ready_gcode_handlers: | 
					
						
							|  |  |  |                 del self.ready_gcode_handlers[cmd] | 
					
						
							|  |  |  |             if cmd in self.base_gcode_handlers: | 
					
						
							|  |  |  |                 del self.base_gcode_handlers[cmd] | 
					
						
							| 
									
										
										
										
											2020-02-12 20:19:18 -05:00
										 |  |  |             return old_cmd | 
					
						
							| 
									
										
										
										
											2018-05-20 13:04:52 -04:00
										 |  |  |         if cmd in self.ready_gcode_handlers: | 
					
						
							| 
									
										
										
										
											2019-02-18 18:04:42 -05:00
										 |  |  |             raise self.printer.config_error( | 
					
						
							|  |  |  |                 "gcode command %s already registered" % (cmd,)) | 
					
						
							| 
									
										
										
										
											2020-01-07 19:06:55 -05:00
										 |  |  |         if not self.is_traditional_gcode(cmd): | 
					
						
							| 
									
										
										
										
											2017-12-03 20:22:44 -05:00
										 |  |  |             origfunc = func | 
					
						
							| 
									
										
										
										
											2019-05-24 18:45:18 -04:00
										 |  |  |             func = lambda params: origfunc(self._get_extended_params(params)) | 
					
						
							| 
									
										
										
										
											2017-12-03 18:53:42 -05:00
										 |  |  |         self.ready_gcode_handlers[cmd] = func | 
					
						
							|  |  |  |         if when_not_ready: | 
					
						
							|  |  |  |             self.base_gcode_handlers[cmd] = func | 
					
						
							|  |  |  |         if desc is not None: | 
					
						
							|  |  |  |             self.gcode_help[cmd] = desc | 
					
						
							| 
									
										
										
										
											2018-05-20 12:33:43 -04:00
										 |  |  |     def register_mux_command(self, cmd, key, value, func, desc=None): | 
					
						
							|  |  |  |         prev = self.mux_commands.get(cmd) | 
					
						
							|  |  |  |         if prev is None: | 
					
						
							| 
									
										
										
										
											2019-05-24 18:45:18 -04:00
										 |  |  |             self.register_command(cmd, self._cmd_mux, desc=desc) | 
					
						
							| 
									
										
										
										
											2018-05-20 12:33:43 -04:00
										 |  |  |             self.mux_commands[cmd] = prev = (key, {}) | 
					
						
							|  |  |  |         prev_key, prev_values = prev | 
					
						
							|  |  |  |         if prev_key != key: | 
					
						
							| 
									
										
										
										
											2019-02-18 18:04:42 -05:00
										 |  |  |             raise self.printer.config_error( | 
					
						
							|  |  |  |                 "mux command %s %s %s may have only one key (%s)" % ( | 
					
						
							|  |  |  |                     cmd, key, value, prev_key)) | 
					
						
							| 
									
										
										
										
											2018-05-20 12:33:43 -04:00
										 |  |  |         if value in prev_values: | 
					
						
							| 
									
										
										
										
											2019-02-18 18:04:42 -05:00
										 |  |  |             raise self.printer.config_error( | 
					
						
							|  |  |  |                 "mux command %s %s %s already registered (%s)" % ( | 
					
						
							|  |  |  |                     cmd, key, value, prev_values)) | 
					
						
							| 
									
										
										
										
											2018-05-20 12:33:43 -04:00
										 |  |  |         prev_values[value] = func | 
					
						
							| 
									
										
										
										
											2020-08-04 14:45:21 -04:00
										 |  |  |     def register_output_handler(self, cb): | 
					
						
							|  |  |  |         self.output_callbacks.append(cb) | 
					
						
							| 
									
										
										
										
											2019-06-12 07:33:28 -04:00
										 |  |  |     def set_move_transform(self, transform, force=False): | 
					
						
							|  |  |  |         if self.move_transform is not None and not force: | 
					
						
							| 
									
										
										
										
											2018-01-20 23:47:36 -05:00
										 |  |  |             raise self.printer.config_error( | 
					
						
							|  |  |  |                 "G-Code move transform already specified") | 
					
						
							| 
									
										
										
										
											2019-06-12 07:33:28 -04:00
										 |  |  |         old_transform = self.move_transform | 
					
						
							|  |  |  |         if old_transform is None: | 
					
						
							|  |  |  |             old_transform = self.toolhead | 
					
						
							| 
									
										
										
										
											2018-01-20 23:47:36 -05:00
										 |  |  |         self.move_transform = transform | 
					
						
							|  |  |  |         self.move_with_transform = transform.move | 
					
						
							|  |  |  |         self.position_with_transform = transform.get_position | 
					
						
							| 
									
										
										
										
											2019-06-12 07:33:28 -04:00
										 |  |  |         return old_transform | 
					
						
							| 
									
										
										
										
											2019-05-28 11:07:11 -04:00
										 |  |  |     def _action_emergency_stop(self, msg="action_emergency_stop"): | 
					
						
							|  |  |  |         self.printer.invoke_shutdown("Shutdown due to %s" % (msg,)) | 
					
						
							|  |  |  |         return "" | 
					
						
							|  |  |  |     def _action_respond_info(self, msg): | 
					
						
							|  |  |  |         self.respond_info(msg) | 
					
						
							|  |  |  |         return "" | 
					
						
							|  |  |  |     def _action_respond_error(self, msg): | 
					
						
							| 
									
										
										
										
											2020-04-24 14:59:25 -04:00
										 |  |  |         self._respond_error(msg) | 
					
						
							| 
									
										
										
										
											2019-05-28 11:07:11 -04:00
										 |  |  |         return "" | 
					
						
							| 
									
										
										
										
											2019-05-24 19:37:08 -04:00
										 |  |  |     def _get_gcode_position(self): | 
					
						
							| 
									
										
										
										
											2019-03-21 15:37:28 +01:00
										 |  |  |         p = [lp - bp for lp, bp in zip(self.last_position, self.base_position)] | 
					
						
							|  |  |  |         p[3] /= self.extrude_factor | 
					
						
							|  |  |  |         return p | 
					
						
							| 
									
										
										
										
											2019-05-24 19:37:08 -04:00
										 |  |  |     def _get_gcode_speed(self): | 
					
						
							|  |  |  |         return self.speed / self.speed_factor | 
					
						
							|  |  |  |     def _get_gcode_speed_override(self): | 
					
						
							|  |  |  |         return self.speed_factor * 60. | 
					
						
							| 
									
										
										
										
											2020-05-26 14:59:15 -04:00
										 |  |  |     def get_status(self, eventtime=None): | 
					
						
							| 
									
										
										
										
											2019-05-24 19:37:08 -04:00
										 |  |  |         move_position = self._get_gcode_position() | 
					
						
							| 
									
										
										
										
											2018-09-17 15:25:28 +03:00
										 |  |  |         return { | 
					
						
							| 
									
										
										
										
											2019-05-24 19:37:08 -04:00
										 |  |  |             'speed_factor': self._get_gcode_speed_override(), | 
					
						
							|  |  |  |             'speed': self._get_gcode_speed(), | 
					
						
							| 
									
										
										
										
											2018-09-17 15:25:28 +03:00
										 |  |  |             'extrude_factor': self.extrude_factor, | 
					
						
							| 
									
										
										
										
											2020-04-22 15:20:59 -04:00
										 |  |  |             'absolute_coordinates': self.absolute_coord, | 
					
						
							|  |  |  |             'absolute_extrude': self.absolute_extrude, | 
					
						
							| 
									
										
										
										
											2019-03-21 15:37:28 +01:00
										 |  |  |             'move_xpos': move_position[0], | 
					
						
							|  |  |  |             'move_ypos': move_position[1], | 
					
						
							|  |  |  |             'move_zpos': move_position[2], | 
					
						
							|  |  |  |             'move_epos': move_position[3], | 
					
						
							| 
									
										
										
										
											2018-09-17 15:25:28 +03:00
										 |  |  |             'last_xpos': self.last_position[0], | 
					
						
							|  |  |  |             'last_ypos': self.last_position[1], | 
					
						
							|  |  |  |             'last_zpos': self.last_position[2], | 
					
						
							|  |  |  |             'last_epos': self.last_position[3], | 
					
						
							|  |  |  |             'base_xpos': self.base_position[0], | 
					
						
							|  |  |  |             'base_ypos': self.base_position[1], | 
					
						
							|  |  |  |             'base_zpos': self.base_position[2], | 
					
						
							|  |  |  |             'base_epos': self.base_position[3], | 
					
						
							|  |  |  |             'homing_xpos': self.homing_position[0], | 
					
						
							|  |  |  |             'homing_ypos': self.homing_position[1], | 
					
						
							| 
									
										
										
										
											2019-05-28 11:07:11 -04:00
										 |  |  |             'homing_zpos': self.homing_position[2], | 
					
						
							| 
									
										
										
										
											2019-05-28 17:40:19 -04:00
										 |  |  |             'gcode_position': homing.Coord(*move_position), | 
					
						
							| 
									
										
										
										
											2019-05-28 11:07:11 -04:00
										 |  |  |             'action_respond_info': self._action_respond_info, | 
					
						
							|  |  |  |             'action_respond_error': self._action_respond_error, | 
					
						
							|  |  |  |             'action_emergency_stop': self._action_emergency_stop, | 
					
						
							| 
									
										
										
										
											2018-09-17 15:25:28 +03:00
										 |  |  |         } | 
					
						
							| 
									
										
										
										
											2019-05-24 18:45:18 -04:00
										 |  |  |     def _handle_shutdown(self): | 
					
						
							| 
									
										
										
										
											2019-01-08 09:15:40 -05:00
										 |  |  |         if not self.is_printer_ready: | 
					
						
							| 
									
										
										
										
											2018-01-19 22:49:27 -05:00
										 |  |  |             return | 
					
						
							| 
									
										
										
										
											2019-01-08 09:15:40 -05:00
										 |  |  |         self.is_printer_ready = False | 
					
						
							|  |  |  |         self.gcode_handlers = self.base_gcode_handlers | 
					
						
							|  |  |  |         self._respond_state("Shutdown") | 
					
						
							| 
									
										
										
										
											2019-05-24 18:45:18 -04:00
										 |  |  |     def _handle_disconnect(self): | 
					
						
							| 
									
										
										
										
											2019-01-08 10:58:35 -05:00
										 |  |  |         self._respond_state("Disconnect") | 
					
						
							| 
									
										
										
										
											2019-05-24 18:45:18 -04:00
										 |  |  |     def _handle_ready(self): | 
					
						
							| 
									
										
										
										
											2017-10-12 15:15:14 -04:00
										 |  |  |         self.is_printer_ready = True | 
					
						
							| 
									
										
										
										
											2017-12-03 18:53:42 -05:00
										 |  |  |         self.gcode_handlers = self.ready_gcode_handlers | 
					
						
							| 
									
										
										
										
											2018-01-19 22:22:17 -05:00
										 |  |  |         self.toolhead = self.printer.lookup_object('toolhead') | 
					
						
							| 
									
										
										
										
											2018-01-20 23:47:36 -05:00
										 |  |  |         if self.move_transform is None: | 
					
						
							|  |  |  |             self.move_with_transform = self.toolhead.move | 
					
						
							|  |  |  |             self.position_with_transform = self.toolhead.get_position | 
					
						
							| 
									
										
										
										
											2018-09-12 18:46:25 -04:00
										 |  |  |         self._respond_state("Ready") | 
					
						
							| 
									
										
										
										
											2019-11-24 19:43:50 -05:00
										 |  |  |     def _handle_activate_extruder(self): | 
					
						
							|  |  |  |         self.reset_last_position() | 
					
						
							|  |  |  |         self.extrude_factor = 1. | 
					
						
							|  |  |  |         self.base_position[3] = self.last_position[3] | 
					
						
							| 
									
										
										
										
											2017-12-03 19:30:49 -05:00
										 |  |  |     def reset_last_position(self): | 
					
						
							| 
									
										
										
										
											2020-05-02 07:34:59 -04:00
										 |  |  |         if self.is_printer_ready: | 
					
						
							|  |  |  |             self.last_position = self.position_with_transform() | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  |     # Parse input into commands | 
					
						
							| 
									
										
										
										
											2017-10-10 11:12:15 -04:00
										 |  |  |     args_r = re.compile('([A-Z_]+|[A-Z*/])') | 
					
						
							| 
									
										
										
										
											2019-05-24 18:45:18 -04:00
										 |  |  |     def _process_commands(self, commands, need_ack=True): | 
					
						
							| 
									
										
										
										
											2017-05-19 21:05:46 -04:00
										 |  |  |         for line in commands: | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  |             # Ignore comments and leading/trailing spaces | 
					
						
							|  |  |  |             line = origline = line.strip() | 
					
						
							|  |  |  |             cpos = line.find(';') | 
					
						
							|  |  |  |             if cpos >= 0: | 
					
						
							|  |  |  |                 line = line[:cpos] | 
					
						
							| 
									
										
										
										
											2020-04-22 12:40:32 -04:00
										 |  |  |             # Break line into parts and determine command | 
					
						
							|  |  |  |             parts = self.args_r.split(line.upper()) | 
					
						
							|  |  |  |             numparts = len(parts) | 
					
						
							|  |  |  |             cmd = "" | 
					
						
							|  |  |  |             if numparts >= 3 and parts[1] != 'N': | 
					
						
							|  |  |  |                 cmd = parts[1] + parts[2].strip() | 
					
						
							|  |  |  |             elif numparts >= 5 and parts[1] == 'N': | 
					
						
							|  |  |  |                 # Skip line number at start of command | 
					
						
							|  |  |  |                 cmd = parts[3] + parts[4].strip() | 
					
						
							|  |  |  |             # Build gcode "params" dictionary | 
					
						
							| 
									
										
										
										
											2017-06-06 15:04:01 -04:00
										 |  |  |             params = { parts[i]: parts[i+1].strip() | 
					
						
							| 
									
										
										
										
											2020-04-22 12:40:32 -04:00
										 |  |  |                        for i in range(1, numparts, 2) } | 
					
						
							| 
									
										
										
										
											2020-04-25 15:30:24 -04:00
										 |  |  |             gcmd = GCodeCommand(self, cmd, origline, params, need_ack) | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  |             # Invoke handler for command | 
					
						
							|  |  |  |             handler = self.gcode_handlers.get(cmd, self.cmd_default) | 
					
						
							|  |  |  |             try: | 
					
						
							| 
									
										
										
										
											2020-04-22 12:40:32 -04:00
										 |  |  |                 handler(gcmd) | 
					
						
							| 
									
										
										
										
											2019-06-03 12:48:35 -04:00
										 |  |  |             except self.error as e: | 
					
						
							| 
									
										
										
										
											2020-04-24 14:59:25 -04:00
										 |  |  |                 self._respond_error(str(e)) | 
					
						
							| 
									
										
										
										
											2017-12-03 19:30:49 -05:00
										 |  |  |                 self.reset_last_position() | 
					
						
							| 
									
										
										
										
											2020-02-12 13:20:12 -05:00
										 |  |  |                 self.printer.send_event("gcode:command_error") | 
					
						
							| 
									
										
										
										
											2018-02-01 12:13:48 -05:00
										 |  |  |                 if not need_ack: | 
					
						
							|  |  |  |                     raise | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  |             except: | 
					
						
							| 
									
										
										
										
											2017-10-12 15:15:14 -04:00
										 |  |  |                 msg = 'Internal error on command:"%s"' % (cmd,) | 
					
						
							|  |  |  |                 logging.exception(msg) | 
					
						
							|  |  |  |                 self.printer.invoke_shutdown(msg) | 
					
						
							| 
									
										
										
										
											2020-04-24 14:59:25 -04:00
										 |  |  |                 self._respond_error(msg) | 
					
						
							| 
									
										
										
										
											2018-02-01 12:13:48 -05:00
										 |  |  |                 if not need_ack: | 
					
						
							|  |  |  |                     raise | 
					
						
							| 
									
										
										
										
											2020-04-25 15:30:24 -04:00
										 |  |  |             gcmd.ack() | 
					
						
							| 
									
										
										
										
											2018-06-30 14:08:02 -04:00
										 |  |  |     def run_script_from_command(self, script): | 
					
						
							| 
									
										
										
										
											2020-04-25 15:30:24 -04:00
										 |  |  |         self._process_commands(script.split('\n'), need_ack=False) | 
					
						
							| 
									
										
										
										
											2018-06-30 14:10:59 -04:00
										 |  |  |     def run_script(self, script): | 
					
						
							| 
									
										
										
										
											2019-06-09 12:01:58 -04:00
										 |  |  |         with self.mutex: | 
					
						
							|  |  |  |             self._process_commands(script.split('\n'), need_ack=False) | 
					
						
							| 
									
										
										
										
											2019-06-09 13:33:21 -04:00
										 |  |  |     def get_mutex(self): | 
					
						
							|  |  |  |         return self.mutex | 
					
						
							| 
									
										
										
										
											2020-04-22 12:40:32 -04:00
										 |  |  |     def create_gcode_command(self, command, commandline, params): | 
					
						
							| 
									
										
										
										
											2020-04-25 15:30:24 -04:00
										 |  |  |         return GCodeCommand(self, command, commandline, params, False) | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  |     # Response handling | 
					
						
							| 
									
										
										
										
											2020-04-24 15:54:18 -04:00
										 |  |  |     def respond_raw(self, msg): | 
					
						
							| 
									
										
										
										
											2020-08-04 14:45:21 -04:00
										 |  |  |         for cb in self.output_callbacks: | 
					
						
							|  |  |  |             cb(msg) | 
					
						
							| 
									
										
										
										
											2019-03-04 13:04:18 -05:00
										 |  |  |     def respond_info(self, msg, log=True): | 
					
						
							|  |  |  |         if log: | 
					
						
							|  |  |  |             logging.info(msg) | 
					
						
							| 
									
										
										
										
											2016-12-21 11:33:03 -05:00
										 |  |  |         lines = [l.strip() for l in msg.strip().split('\n')] | 
					
						
							| 
									
										
										
										
											2020-04-24 15:54:18 -04:00
										 |  |  |         self.respond_raw("// " + "\n// ".join(lines)) | 
					
						
							| 
									
										
										
										
											2020-04-24 14:59:25 -04:00
										 |  |  |     def _respond_error(self, msg): | 
					
						
							| 
									
										
										
										
											2017-07-17 11:24:15 -04:00
										 |  |  |         logging.warning(msg) | 
					
						
							| 
									
										
										
										
											2016-11-30 14:30:45 -05:00
										 |  |  |         lines = msg.strip().split('\n') | 
					
						
							| 
									
										
										
										
											2016-12-21 11:33:03 -05:00
										 |  |  |         if len(lines) > 1: | 
					
						
							| 
									
										
										
										
											2019-03-04 13:04:18 -05:00
										 |  |  |             self.respond_info("\n".join(lines), log=False) | 
					
						
							| 
									
										
										
										
											2020-04-24 15:54:18 -04:00
										 |  |  |         self.respond_raw('!! %s' % (lines[0].strip(),)) | 
					
						
							| 
									
										
										
										
											2018-06-16 15:15:17 -04:00
										 |  |  |         if self.is_fileinput: | 
					
						
							|  |  |  |             self.printer.request_exit('error_exit') | 
					
						
							| 
									
										
										
										
											2018-09-12 18:46:25 -04:00
										 |  |  |     def _respond_state(self, state): | 
					
						
							| 
									
										
										
										
											2019-03-04 13:04:18 -05:00
										 |  |  |         self.respond_info("Klipper state: %s" % (state,), log=False) | 
					
						
							| 
									
										
										
										
											2017-03-15 23:40:46 -04:00
										 |  |  |     # Parameter parsing helpers | 
					
						
							| 
									
										
										
										
											2017-06-06 15:04:01 -04:00
										 |  |  |     extended_r = re.compile( | 
					
						
							|  |  |  |         r'^\s*(?:N[0-9]+\s*)?' | 
					
						
							| 
									
										
										
										
											2020-01-07 19:06:55 -05:00
										 |  |  |         r'(?P<cmd>[a-zA-Z_][a-zA-Z0-9_]+)(?:\s+|$)' | 
					
						
							| 
									
										
										
										
											2017-06-06 15:04:01 -04:00
										 |  |  |         r'(?P<args>[^#*;]*?)' | 
					
						
							|  |  |  |         r'\s*(?:[#*;].*)?$') | 
					
						
							| 
									
										
										
										
											2020-04-22 12:40:32 -04:00
										 |  |  |     def _get_extended_params(self, gcmd): | 
					
						
							|  |  |  |         m = self.extended_r.match(gcmd.get_commandline()) | 
					
						
							| 
									
										
										
										
											2017-06-06 15:04:01 -04:00
										 |  |  |         if m is None: | 
					
						
							| 
									
										
										
										
											2020-04-22 12:40:32 -04:00
										 |  |  |             raise self.error("Malformed command '%s'" | 
					
						
							|  |  |  |                              % (gcmd.get_commandline(),)) | 
					
						
							| 
									
										
										
										
											2017-06-06 15:04:01 -04:00
										 |  |  |         eargs = m.group('args') | 
					
						
							|  |  |  |         try: | 
					
						
							| 
									
										
										
										
											2019-01-02 14:45:35 -08:00
										 |  |  |             eparams = [earg.split('=', 1) for earg in shlex.split(eargs)] | 
					
						
							| 
									
										
										
										
											2017-10-02 21:48:45 -04:00
										 |  |  |             eparams = { k.upper(): v for k, v in eparams } | 
					
						
							| 
									
										
										
										
											2020-04-22 12:40:32 -04:00
										 |  |  |             gcmd._params.clear() | 
					
						
							|  |  |  |             gcmd._params.update(eparams) | 
					
						
							|  |  |  |             return gcmd | 
					
						
							| 
									
										
										
										
											2017-06-06 15:04:01 -04:00
										 |  |  |         except ValueError as e: | 
					
						
							| 
									
										
										
										
											2020-04-22 12:40:32 -04:00
										 |  |  |             raise self.error("Malformed command '%s'" | 
					
						
							|  |  |  |                              % (gcmd.get_commandline(),)) | 
					
						
							| 
									
										
										
										
											2017-12-21 20:45:07 -05:00
										 |  |  |     # G-Code special command handlers | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_default(self, gcmd): | 
					
						
							|  |  |  |         cmd = gcmd.get_command() | 
					
						
							| 
									
										
										
										
											2020-04-25 13:06:51 -04:00
										 |  |  |         if cmd == 'M105': | 
					
						
							|  |  |  |             # Don't warn about temperature requests when not ready | 
					
						
							| 
									
										
										
										
											2020-04-25 15:30:24 -04:00
										 |  |  |             gcmd.ack("T:0") | 
					
						
							| 
									
										
										
										
											2020-04-25 13:06:51 -04:00
										 |  |  |             return | 
					
						
							| 
									
										
										
										
											2016-11-22 19:38:51 -05:00
										 |  |  |         if not self.is_printer_ready: | 
					
						
							| 
									
										
										
										
											2020-06-23 07:56:50 -04:00
										 |  |  |             raise gcmd.error(self.printer.get_state_message()[0]) | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  |             return | 
					
						
							|  |  |  |         if not cmd: | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |             logging.debug(gcmd.get_commandline()) | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  |             return | 
					
						
							| 
									
										
										
										
											2019-11-24 19:59:36 -05:00
										 |  |  |         if cmd.startswith("M117 "): | 
					
						
							| 
									
										
										
										
											2018-08-21 20:59:51 -04:00
										 |  |  |             # Handle M117 gcode with numeric and special characters | 
					
						
							|  |  |  |             handler = self.gcode_handlers.get("M117", None) | 
					
						
							|  |  |  |             if handler is not None: | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |                 handler(gcmd) | 
					
						
							| 
									
										
										
										
											2018-08-21 20:59:51 -04:00
										 |  |  |                 return | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |         elif cmd in ['M140', 'M104'] and not gcmd.get_float('S', 0.): | 
					
						
							| 
									
										
										
										
											2019-12-16 19:35:49 -05:00
										 |  |  |             # Don't warn about requests to turn off heaters when not present | 
					
						
							|  |  |  |             return | 
					
						
							| 
									
										
										
										
											2019-11-13 11:29:27 -05:00
										 |  |  |         elif cmd == 'M107' or (cmd == 'M106' and ( | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |                 not gcmd.get_float('S', 1.) or self.is_fileinput)): | 
					
						
							| 
									
										
										
										
											2019-11-13 11:29:27 -05:00
										 |  |  |             # Don't warn about requests to turn off fan when fan not present | 
					
						
							|  |  |  |             return | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |         gcmd.respond_info('Unknown command:"%s"' % (cmd,)) | 
					
						
							|  |  |  |     def _cmd_mux(self, gcmd): | 
					
						
							|  |  |  |         key, values = self.mux_commands[gcmd.get_command()] | 
					
						
							| 
									
										
										
										
											2018-05-20 12:33:43 -04:00
										 |  |  |         if None in values: | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |             key_param = gcmd.get(key, None) | 
					
						
							| 
									
										
										
										
											2018-05-20 12:33:43 -04:00
										 |  |  |         else: | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |             key_param = gcmd.get(key) | 
					
						
							| 
									
										
										
										
											2018-05-20 12:33:43 -04:00
										 |  |  |         if key_param not in values: | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |             raise gcmd.error("The value '%s' is not valid for %s" | 
					
						
							|  |  |  |                              % (key_param, key)) | 
					
						
							|  |  |  |         values[key_param](gcmd) | 
					
						
							| 
									
										
										
										
											2017-04-25 18:34:15 -04:00
										 |  |  |     all_handlers = [ | 
					
						
							| 
									
										
										
										
											2019-11-10 11:55:53 -05:00
										 |  |  |         'G1', 'G4', 'G28', 'M400', | 
					
						
							| 
									
										
										
										
											2018-04-20 19:58:37 -04:00
										 |  |  |         'G20', 'M82', 'M83', 'G90', 'G91', 'G92', 'M114', 'M220', 'M221', | 
					
						
							| 
									
										
										
										
											2019-11-24 21:10:51 -05:00
										 |  |  |         'SET_GCODE_OFFSET', 'SAVE_GCODE_STATE', 'RESTORE_GCODE_STATE', | 
					
						
							| 
									
										
										
										
											2020-04-25 13:06:51 -04:00
										 |  |  |         'M112', 'M115', 'IGNORE', 'GET_POSITION', | 
					
						
							| 
									
										
										
										
											2017-06-06 15:04:01 -04:00
										 |  |  |         'RESTART', 'FIRMWARE_RESTART', 'ECHO', 'STATUS', 'HELP'] | 
					
						
							| 
									
										
										
										
											2017-12-21 20:45:07 -05:00
										 |  |  |     # G-Code movement commands | 
					
						
							| 
									
										
										
										
											2016-11-30 22:34:38 -05:00
										 |  |  |     cmd_G1_aliases = ['G0'] | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_G1(self, gcmd): | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  |         # Move | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |         params = gcmd._params | 
					
						
							| 
									
										
										
										
											2017-03-15 23:40:46 -04:00
										 |  |  |         try: | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |             for pos, axis in enumerate('XYZ'): | 
					
						
							| 
									
										
										
										
											2017-12-21 21:33:38 -05:00
										 |  |  |                 if axis in params: | 
					
						
							|  |  |  |                     v = float(params[axis]) | 
					
						
							| 
									
										
										
										
											2019-05-26 20:59:44 -04:00
										 |  |  |                     if not self.absolute_coord: | 
					
						
							| 
									
										
										
										
											2017-03-15 23:40:46 -04:00
										 |  |  |                         # value relative to position of last move | 
					
						
							| 
									
										
										
										
											2017-12-21 21:33:38 -05:00
										 |  |  |                         self.last_position[pos] += v | 
					
						
							| 
									
										
										
										
											2017-03-15 23:40:46 -04:00
										 |  |  |                     else: | 
					
						
							|  |  |  |                         # value relative to base coordinate position | 
					
						
							| 
									
										
										
										
											2017-12-21 21:33:38 -05:00
										 |  |  |                         self.last_position[pos] = v + self.base_position[pos] | 
					
						
							|  |  |  |             if 'E' in params: | 
					
						
							|  |  |  |                 v = float(params['E']) * self.extrude_factor | 
					
						
							| 
									
										
										
										
											2019-05-26 20:59:44 -04:00
										 |  |  |                 if not self.absolute_coord or not self.absolute_extrude: | 
					
						
							| 
									
										
										
										
											2017-12-21 21:33:38 -05:00
										 |  |  |                     # value relative to position of last move | 
					
						
							|  |  |  |                     self.last_position[3] += v | 
					
						
							|  |  |  |                 else: | 
					
						
							|  |  |  |                     # value relative to base coordinate position | 
					
						
							|  |  |  |                     self.last_position[3] = v + self.base_position[3] | 
					
						
							| 
									
										
										
										
											2017-03-15 23:40:46 -04:00
										 |  |  |             if 'F' in params: | 
					
						
							| 
									
										
										
										
											2019-05-24 19:37:08 -04:00
										 |  |  |                 gcode_speed = float(params['F']) | 
					
						
							|  |  |  |                 if gcode_speed <= 0.: | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |                     raise gcmd.error("Invalid speed in '%s'" | 
					
						
							|  |  |  |                                      % (gcmd.get_commandline(),)) | 
					
						
							| 
									
										
										
										
											2019-05-24 19:37:08 -04:00
										 |  |  |                 self.speed = gcode_speed * self.speed_factor | 
					
						
							| 
									
										
										
										
											2017-06-09 23:32:49 -04:00
										 |  |  |         except ValueError as e: | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |             raise gcmd.error("Unable to parse move '%s'" | 
					
						
							|  |  |  |                              % (gcmd.get_commandline(),)) | 
					
						
							| 
									
										
										
										
											2019-06-03 12:53:50 -04:00
										 |  |  |         self.move_with_transform(self.last_position, self.speed) | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_G4(self, gcmd): | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  |         # Dwell | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |         delay = gcmd.get_float('P', 0., minval=0.) / 1000. | 
					
						
							| 
									
										
										
										
											2016-07-07 14:23:48 -04:00
										 |  |  |         self.toolhead.dwell(delay) | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_G28(self, gcmd): | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  |         # Move to origin | 
					
						
							| 
									
										
										
										
											2016-07-25 23:47:30 -04:00
										 |  |  |         axes = [] | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |         for pos, axis in enumerate('XYZ'): | 
					
						
							|  |  |  |             if gcmd.get(axis, None) is not None: | 
					
						
							|  |  |  |                 axes.append(pos) | 
					
						
							| 
									
										
										
										
											2016-07-25 23:47:30 -04:00
										 |  |  |         if not axes: | 
					
						
							|  |  |  |             axes = [0, 1, 2] | 
					
						
							| 
									
										
										
										
											2018-10-08 14:23:20 -04:00
										 |  |  |         homing_state = homing.Homing(self.printer) | 
					
						
							| 
									
										
										
										
											2016-11-20 20:40:31 -05:00
										 |  |  |         if self.is_fileinput: | 
					
						
							| 
									
										
										
										
											2016-11-28 11:23:26 -05:00
										 |  |  |             homing_state.set_no_verify_retract() | 
					
						
							| 
									
										
										
										
											2019-06-03 12:53:50 -04:00
										 |  |  |         homing_state.home_axes(axes) | 
					
						
							| 
									
										
										
										
											2016-12-08 18:12:20 -05:00
										 |  |  |         for axis in homing_state.get_axes(): | 
					
						
							| 
									
										
										
										
											2018-04-20 19:42:26 -04:00
										 |  |  |             self.base_position[axis] = self.homing_position[axis] | 
					
						
							| 
									
										
										
										
											2018-01-16 21:46:42 -05:00
										 |  |  |         self.reset_last_position() | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_M400(self, gcmd): | 
					
						
							| 
									
										
										
										
											2017-12-21 20:45:07 -05:00
										 |  |  |         # Wait for current moves to finish | 
					
						
							|  |  |  |         self.toolhead.wait_moves() | 
					
						
							|  |  |  |     # G-Code coordinate manipulation | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_G20(self, gcmd): | 
					
						
							| 
									
										
										
										
											2017-12-21 20:45:07 -05:00
										 |  |  |         # Set units to inches | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |         raise gcmd.error('Machine does not support G20 (inches) command') | 
					
						
							|  |  |  |     def cmd_M82(self, gcmd): | 
					
						
							| 
									
										
										
										
											2017-12-21 20:45:07 -05:00
										 |  |  |         # Use absolute distances for extrusion | 
					
						
							| 
									
										
										
										
											2019-05-26 20:59:44 -04:00
										 |  |  |         self.absolute_extrude = True | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_M83(self, gcmd): | 
					
						
							| 
									
										
										
										
											2017-12-21 20:45:07 -05:00
										 |  |  |         # Use relative distances for extrusion | 
					
						
							| 
									
										
										
										
											2019-05-26 20:59:44 -04:00
										 |  |  |         self.absolute_extrude = False | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_G90(self, gcmd): | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  |         # Use absolute coordinates | 
					
						
							| 
									
										
										
										
											2019-05-26 20:59:44 -04:00
										 |  |  |         self.absolute_coord = True | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_G91(self, gcmd): | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  |         # Use relative coordinates | 
					
						
							| 
									
										
										
										
											2019-05-26 20:59:44 -04:00
										 |  |  |         self.absolute_coord = False | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_G92(self, gcmd): | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  |         # Set position | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |         offsets = [ gcmd.get_float(a, None) for a in 'XYZE' ] | 
					
						
							|  |  |  |         for i, offset in enumerate(offsets): | 
					
						
							|  |  |  |             if offset is not None: | 
					
						
							|  |  |  |                 if i == 3: | 
					
						
							|  |  |  |                     offset *= self.extrude_factor | 
					
						
							|  |  |  |                 self.base_position[i] = self.last_position[i] - offset | 
					
						
							|  |  |  |         if offsets == [None, None, None, None]: | 
					
						
							| 
									
										
										
										
											2016-05-25 11:37:40 -04:00
										 |  |  |             self.base_position = list(self.last_position) | 
					
						
							| 
									
										
										
										
											2018-03-09 21:43:24 -05:00
										 |  |  |     cmd_M114_when_not_ready = True | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_M114(self, gcmd): | 
					
						
							| 
									
										
										
										
											2018-03-09 21:43:24 -05:00
										 |  |  |         # Get Current Position | 
					
						
							| 
									
										
										
										
											2019-05-24 19:37:08 -04:00
										 |  |  |         p = self._get_gcode_position() | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |         gcmd.respond_raw("X:%.3f Y:%.3f Z:%.3f E:%.3f" % tuple(p)) | 
					
						
							|  |  |  |     def cmd_M220(self, gcmd): | 
					
						
							| 
									
										
										
										
											2017-12-21 20:53:44 -05:00
										 |  |  |         # Set speed factor override percentage | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |         value = gcmd.get_float('S', 100., above=0.) / (60. * 100.) | 
					
						
							| 
									
										
										
										
											2019-05-24 19:37:08 -04:00
										 |  |  |         self.speed = self._get_gcode_speed() * value | 
					
						
							| 
									
										
										
										
											2017-12-21 20:53:44 -05:00
										 |  |  |         self.speed_factor = value | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_M221(self, gcmd): | 
					
						
							| 
									
										
										
										
											2017-12-21 21:33:38 -05:00
										 |  |  |         # Set extrude factor override percentage | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |         new_extrude_factor = gcmd.get_float('S', 100., above=0.) / 100. | 
					
						
							| 
									
										
										
										
											2017-12-21 21:33:38 -05:00
										 |  |  |         last_e_pos = self.last_position[3] | 
					
						
							|  |  |  |         e_value = (last_e_pos - self.base_position[3]) / self.extrude_factor | 
					
						
							|  |  |  |         self.base_position[3] = last_e_pos - e_value * new_extrude_factor | 
					
						
							|  |  |  |         self.extrude_factor = new_extrude_factor | 
					
						
							| 
									
										
										
										
											2018-04-20 19:58:37 -04:00
										 |  |  |     cmd_SET_GCODE_OFFSET_help = "Set a virtual offset to g-code positions" | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_SET_GCODE_OFFSET(self, gcmd): | 
					
						
							| 
									
										
										
										
											2019-05-20 22:36:57 -04:00
										 |  |  |         move_delta = [0., 0., 0., 0.] | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |         for pos, axis in enumerate('XYZE'): | 
					
						
							|  |  |  |             offset = gcmd.get_float(axis, None) | 
					
						
							|  |  |  |             if offset is None: | 
					
						
							|  |  |  |                 offset = gcmd.get_float(axis + '_ADJUST', None) | 
					
						
							|  |  |  |                 if offset is None: | 
					
						
							|  |  |  |                     continue | 
					
						
							|  |  |  |                 offset += self.homing_position[pos] | 
					
						
							| 
									
										
										
										
											2018-05-29 14:09:04 -04:00
										 |  |  |             delta = offset - self.homing_position[pos] | 
					
						
							| 
									
										
										
										
											2019-05-20 22:36:57 -04:00
										 |  |  |             move_delta[pos] = delta | 
					
						
							| 
									
										
										
										
											2018-05-29 14:09:04 -04:00
										 |  |  |             self.base_position[pos] += delta | 
					
						
							| 
									
										
										
										
											2018-04-20 19:58:37 -04:00
										 |  |  |             self.homing_position[pos] = offset | 
					
						
							| 
									
										
										
										
											2019-05-20 22:36:57 -04:00
										 |  |  |         # Move the toolhead the given offset if requested | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |         if gcmd.get_int('MOVE', 0): | 
					
						
							|  |  |  |             speed = gcmd.get_float('MOVE_SPEED', self.speed, above=0.) | 
					
						
							| 
									
										
										
										
											2019-05-20 22:36:57 -04:00
										 |  |  |             for pos, delta in enumerate(move_delta): | 
					
						
							|  |  |  |                 self.last_position[pos] += delta | 
					
						
							| 
									
										
										
										
											2019-06-03 12:53:50 -04:00
										 |  |  |             self.move_with_transform(self.last_position, speed) | 
					
						
							| 
									
										
										
										
											2019-05-26 11:08:48 -04:00
										 |  |  |     cmd_SAVE_GCODE_STATE_help = "Save G-Code coordinate state" | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_SAVE_GCODE_STATE(self, gcmd): | 
					
						
							|  |  |  |         state_name = gcmd.get('NAME', 'default') | 
					
						
							| 
									
										
										
										
											2019-05-26 11:08:48 -04:00
										 |  |  |         self.saved_states[state_name] = { | 
					
						
							|  |  |  |             'absolute_coord': self.absolute_coord, | 
					
						
							|  |  |  |             'absolute_extrude': self.absolute_extrude, | 
					
						
							|  |  |  |             'base_position': list(self.base_position), | 
					
						
							|  |  |  |             'last_position': list(self.last_position), | 
					
						
							|  |  |  |             'homing_position': list(self.homing_position), | 
					
						
							|  |  |  |             'speed': self.speed, 'speed_factor': self.speed_factor, | 
					
						
							|  |  |  |             'extrude_factor': self.extrude_factor, | 
					
						
							|  |  |  |         } | 
					
						
							|  |  |  |     cmd_RESTORE_GCODE_STATE_help = "Restore a previously saved G-Code state" | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_RESTORE_GCODE_STATE(self, gcmd): | 
					
						
							|  |  |  |         state_name = gcmd.get('NAME', 'default') | 
					
						
							| 
									
										
										
										
											2019-05-26 11:08:48 -04:00
										 |  |  |         state = self.saved_states.get(state_name) | 
					
						
							|  |  |  |         if state is None: | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |             raise gcmd.error("Unknown g-code state: %s" % (state_name,)) | 
					
						
							| 
									
										
										
										
											2019-05-26 11:08:48 -04:00
										 |  |  |         # Restore state | 
					
						
							|  |  |  |         self.absolute_coord = state['absolute_coord'] | 
					
						
							|  |  |  |         self.absolute_extrude = state['absolute_extrude'] | 
					
						
							|  |  |  |         self.base_position = list(state['base_position']) | 
					
						
							|  |  |  |         self.homing_position = list(state['homing_position']) | 
					
						
							|  |  |  |         self.speed = state['speed'] | 
					
						
							|  |  |  |         self.speed_factor = state['speed_factor'] | 
					
						
							|  |  |  |         self.extrude_factor = state['extrude_factor'] | 
					
						
							|  |  |  |         # Restore the relative E position | 
					
						
							|  |  |  |         e_diff = self.last_position[3] - state['last_position'][3] | 
					
						
							|  |  |  |         self.base_position[3] += e_diff | 
					
						
							|  |  |  |         # Move the toolhead back if requested | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |         if gcmd.get_int('MOVE', 0): | 
					
						
							|  |  |  |             speed = gcmd.get_float('MOVE_SPEED', self.speed, above=0.) | 
					
						
							| 
									
										
										
										
											2019-05-26 11:08:48 -04:00
										 |  |  |             self.last_position[:3] = state['last_position'][:3] | 
					
						
							| 
									
										
										
										
											2019-06-03 12:53:50 -04:00
										 |  |  |             self.move_with_transform(self.last_position, speed) | 
					
						
							| 
									
										
										
										
											2019-12-16 20:08:00 -05:00
										 |  |  |     # G-Code miscellaneous commands | 
					
						
							| 
									
										
										
										
											2017-12-03 18:16:23 -05:00
										 |  |  |     cmd_M112_when_not_ready = True | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_M112(self, gcmd): | 
					
						
							| 
									
										
										
										
											2016-12-09 13:55:18 -05:00
										 |  |  |         # Emergency Stop | 
					
						
							| 
									
										
										
										
											2017-10-12 15:15:14 -04:00
										 |  |  |         self.printer.invoke_shutdown("Shutdown due to M112 command") | 
					
						
							| 
									
										
										
										
											2016-12-28 21:45:29 -05:00
										 |  |  |     cmd_M115_when_not_ready = True | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_M115(self, gcmd): | 
					
						
							| 
									
										
										
										
											2016-12-28 21:45:29 -05:00
										 |  |  |         # Get Firmware Version and Capabilities | 
					
						
							| 
									
										
										
										
											2017-08-21 17:19:43 -04:00
										 |  |  |         software_version = self.printer.get_start_args().get('software_version') | 
					
						
							|  |  |  |         kw = {"FIRMWARE_NAME": "Klipper", "FIRMWARE_VERSION": software_version} | 
					
						
							| 
									
										
										
										
											2020-04-25 15:30:24 -04:00
										 |  |  |         gcmd.ack(" ".join(["%s:%s" % (k, v) for k, v in kw.items()])) | 
					
						
							| 
									
										
										
										
											2017-04-20 10:11:10 -04:00
										 |  |  |     cmd_IGNORE_when_not_ready = True | 
					
						
							|  |  |  |     cmd_IGNORE_aliases = ["G21", "M110", "M21"] | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_IGNORE(self, gcmd): | 
					
						
							| 
									
										
										
										
											2017-04-20 10:11:10 -04:00
										 |  |  |         # Commands that are just silently accepted | 
					
						
							|  |  |  |         pass | 
					
						
							| 
									
										
										
										
											2018-03-09 21:43:24 -05:00
										 |  |  |     cmd_GET_POSITION_when_not_ready = True | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_GET_POSITION(self, gcmd): | 
					
						
							| 
									
										
										
										
											2018-03-09 21:43:24 -05:00
										 |  |  |         if self.toolhead is None: | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |             self.cmd_default(gcmd) | 
					
						
							| 
									
										
										
										
											2018-03-09 21:43:24 -05:00
										 |  |  |             return | 
					
						
							|  |  |  |         kin = self.toolhead.get_kinematics() | 
					
						
							| 
									
										
										
										
											2018-07-16 10:16:16 -04:00
										 |  |  |         steppers = kin.get_steppers() | 
					
						
							| 
									
										
										
										
											2018-06-21 18:15:23 -04:00
										 |  |  |         mcu_pos = " ".join(["%s:%d" % (s.get_name(), s.get_mcu_position()) | 
					
						
							| 
									
										
										
										
											2018-03-09 21:43:24 -05:00
										 |  |  |                             for s in steppers]) | 
					
						
							| 
									
										
										
										
											2019-11-13 17:59:40 -05:00
										 |  |  |         for s in steppers: | 
					
						
							|  |  |  |             s.set_tag_position(s.get_commanded_position()) | 
					
						
							|  |  |  |         stepper_pos = " ".join(["%s:%.6f" % (s.get_name(), s.get_tag_position()) | 
					
						
							|  |  |  |                                 for s in steppers]) | 
					
						
							|  |  |  |         kin_pos = " ".join(["%s:%.6f" % (a, v) | 
					
						
							|  |  |  |                             for a, v in zip("XYZ", kin.calc_tag_position())]) | 
					
						
							| 
									
										
										
										
											2018-03-09 21:43:24 -05:00
										 |  |  |         toolhead_pos = " ".join(["%s:%.6f" % (a, v) for a, v in zip( | 
					
						
							|  |  |  |             "XYZE", self.toolhead.get_position())]) | 
					
						
							|  |  |  |         gcode_pos = " ".join(["%s:%.6f"  % (a, v) | 
					
						
							|  |  |  |                               for a, v in zip("XYZE", self.last_position)]) | 
					
						
							| 
									
										
										
										
											2018-04-20 19:42:26 -04:00
										 |  |  |         base_pos = " ".join(["%s:%.6f"  % (a, v) | 
					
						
							|  |  |  |                              for a, v in zip("XYZE", self.base_position)]) | 
					
						
							| 
									
										
										
										
											2018-03-09 21:43:24 -05:00
										 |  |  |         homing_pos = " ".join(["%s:%.6f"  % (a, v) | 
					
						
							| 
									
										
										
										
											2018-04-20 19:42:26 -04:00
										 |  |  |                                for a, v in zip("XYZ", self.homing_position)]) | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |         gcmd.respond_info("mcu: %s\n" | 
					
						
							| 
									
										
										
										
											2019-11-13 17:59:40 -05:00
										 |  |  |                           "stepper: %s\n" | 
					
						
							|  |  |  |                           "kinematic: %s\n" | 
					
						
							|  |  |  |                           "toolhead: %s\n" | 
					
						
							|  |  |  |                           "gcode: %s\n" | 
					
						
							|  |  |  |                           "gcode base: %s\n" | 
					
						
							|  |  |  |                           "gcode homing: %s" | 
					
						
							|  |  |  |                           % (mcu_pos, stepper_pos, kin_pos, toolhead_pos, | 
					
						
							|  |  |  |                              gcode_pos, base_pos, homing_pos)) | 
					
						
							| 
									
										
										
										
											2018-02-11 13:52:20 -05:00
										 |  |  |     def request_restart(self, result): | 
					
						
							| 
									
										
										
										
											2017-02-12 18:42:29 -05:00
										 |  |  |         if self.is_printer_ready: | 
					
						
							| 
									
										
										
										
											2018-02-11 13:52:20 -05:00
										 |  |  |             print_time = self.toolhead.get_last_move_time() | 
					
						
							| 
									
										
										
										
											2020-07-28 14:59:04 -04:00
										 |  |  |             if result == 'exit': | 
					
						
							|  |  |  |                 logging.info("Exiting (print time %.3fs)" % (print_time,)) | 
					
						
							| 
									
										
										
										
											2019-02-25 21:26:27 -05:00
										 |  |  |             self.printer.send_event("gcode:request_restart", print_time) | 
					
						
							| 
									
										
										
										
											2017-02-12 18:42:29 -05:00
										 |  |  |             self.toolhead.dwell(0.500) | 
					
						
							|  |  |  |             self.toolhead.wait_moves() | 
					
						
							| 
									
										
										
										
											2018-02-11 13:52:20 -05:00
										 |  |  |         self.printer.request_exit(result) | 
					
						
							| 
									
										
										
										
											2017-03-08 22:26:10 -05:00
										 |  |  |     cmd_RESTART_when_not_ready = True | 
					
						
							|  |  |  |     cmd_RESTART_help = "Reload config file and restart host software" | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_RESTART(self, gcmd): | 
					
						
							| 
									
										
										
										
											2018-02-11 13:52:20 -05:00
										 |  |  |         self.request_restart('restart') | 
					
						
							| 
									
										
										
										
											2017-03-08 22:26:10 -05:00
										 |  |  |     cmd_FIRMWARE_RESTART_when_not_ready = True | 
					
						
							|  |  |  |     cmd_FIRMWARE_RESTART_help = "Restart firmware, host, and reload config" | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_FIRMWARE_RESTART(self, gcmd): | 
					
						
							| 
									
										
										
										
											2018-02-11 13:52:20 -05:00
										 |  |  |         self.request_restart('firmware_restart') | 
					
						
							| 
									
										
										
										
											2017-09-02 11:59:27 -04:00
										 |  |  |     cmd_ECHO_when_not_ready = True | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_ECHO(self, gcmd): | 
					
						
							|  |  |  |         gcmd.respond_info(gcmd.get_commandline(), log=False) | 
					
						
							| 
									
										
										
										
											2016-12-21 11:33:03 -05:00
										 |  |  |     cmd_STATUS_when_not_ready = True | 
					
						
							|  |  |  |     cmd_STATUS_help = "Report the printer status" | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_STATUS(self, gcmd): | 
					
						
							| 
									
										
										
										
											2016-12-21 11:33:03 -05:00
										 |  |  |         if self.is_printer_ready: | 
					
						
							| 
									
										
										
										
											2018-09-12 18:46:25 -04:00
										 |  |  |             self._respond_state("Ready") | 
					
						
							|  |  |  |             return | 
					
						
							| 
									
										
										
										
											2020-06-23 07:56:50 -04:00
										 |  |  |         msg = self.printer.get_state_message()[0] | 
					
						
							| 
									
										
										
										
											2018-10-13 17:20:21 -04:00
										 |  |  |         msg = msg.rstrip() + "\nKlipper state: Not ready" | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |         raise gcmd.error(msg) | 
					
						
							| 
									
										
										
										
											2016-11-30 23:47:40 -05:00
										 |  |  |     cmd_HELP_when_not_ready = True | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |     def cmd_HELP(self, gcmd): | 
					
						
							| 
									
										
										
										
											2016-12-21 11:33:03 -05:00
										 |  |  |         cmdhelp = [] | 
					
						
							|  |  |  |         if not self.is_printer_ready: | 
					
						
							|  |  |  |             cmdhelp.append("Printer is not ready - not all commands available.") | 
					
						
							|  |  |  |         cmdhelp.append("Available extended commands:") | 
					
						
							| 
									
										
										
										
											2017-04-26 10:44:22 -04:00
										 |  |  |         for cmd in sorted(self.gcode_handlers): | 
					
						
							| 
									
										
										
										
											2017-12-03 18:53:42 -05:00
										 |  |  |             if cmd in self.gcode_help: | 
					
						
							|  |  |  |                 cmdhelp.append("%-10s: %s" % (cmd, self.gcode_help[cmd])) | 
					
						
							| 
									
										
										
										
											2020-04-24 19:27:35 -04:00
										 |  |  |         gcmd.respond_info("\n".join(cmdhelp), log=False) | 
					
						
							| 
									
										
										
										
											2020-08-04 16:32:19 -04:00
										 |  |  |     # Webhooks | 
					
						
							|  |  |  |     def _handle_remote_help(self, web_request): | 
					
						
							|  |  |  |         if web_request.get_method() != 'GET': | 
					
						
							|  |  |  |             raise web_request.error("Invalid Request Method") | 
					
						
							|  |  |  |         web_request.send(dict(self.gcode_help)) | 
					
						
							|  |  |  |     def _handle_remote_restart(self, web_request): | 
					
						
							|  |  |  |         if web_request.get_method() != 'POST': | 
					
						
							|  |  |  |             raise web_request.error("Invalid Request Method") | 
					
						
							|  |  |  |         path = web_request.get_path() | 
					
						
							|  |  |  |         if path == "gcode/restart": | 
					
						
							|  |  |  |             self.run_script('restart') | 
					
						
							|  |  |  |         elif path == "gcode/firmware_restart": | 
					
						
							|  |  |  |             self.run_script('firmware_restart') | 
					
						
							|  |  |  |     def _handle_remote_script(self, web_request): | 
					
						
							|  |  |  |         if web_request.get_method() != 'POST': | 
					
						
							|  |  |  |             raise web_request.error("Invalid Request Method") | 
					
						
							|  |  |  |         script = web_request.get('script') | 
					
						
							|  |  |  |         self.run_script(script) | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | # Support reading gcode from a pseudo-tty interface | 
					
						
							|  |  |  | class GCodeIO: | 
					
						
							|  |  |  |     def __init__(self, printer): | 
					
						
							|  |  |  |         self.printer = printer | 
					
						
							|  |  |  |         printer.register_event_handler("klippy:ready", self._handle_ready) | 
					
						
							|  |  |  |         printer.register_event_handler("klippy:shutdown", self._handle_shutdown) | 
					
						
							|  |  |  |         self.gcode = printer.lookup_object('gcode') | 
					
						
							|  |  |  |         self.gcode_mutex = self.gcode.get_mutex() | 
					
						
							|  |  |  |         self.fd = printer.get_start_args().get("gcode_fd") | 
					
						
							|  |  |  |         self.reactor = printer.get_reactor() | 
					
						
							|  |  |  |         self.is_printer_ready = False | 
					
						
							|  |  |  |         self.is_processing_data = False | 
					
						
							|  |  |  |         self.is_fileinput = not not printer.get_start_args().get("debuginput") | 
					
						
							|  |  |  |         self.pipe_is_active = True | 
					
						
							|  |  |  |         self.fd_handle = None | 
					
						
							|  |  |  |         if not self.is_fileinput: | 
					
						
							|  |  |  |             self.gcode.register_output_handler(self._respond_raw) | 
					
						
							|  |  |  |             self.fd_handle = self.reactor.register_fd(self.fd, | 
					
						
							|  |  |  |                                                       self._process_data) | 
					
						
							|  |  |  |         self.partial_input = "" | 
					
						
							|  |  |  |         self.pending_commands = [] | 
					
						
							|  |  |  |         self.bytes_read = 0 | 
					
						
							|  |  |  |         self.input_log = collections.deque([], 50) | 
					
						
							|  |  |  |     def _handle_ready(self): | 
					
						
							|  |  |  |         self.is_printer_ready = True | 
					
						
							|  |  |  |         if self.is_fileinput and self.fd_handle is None: | 
					
						
							|  |  |  |             self.fd_handle = self.reactor.register_fd(self.fd, | 
					
						
							|  |  |  |                                                       self._process_data) | 
					
						
							|  |  |  |     def _dump_debug(self): | 
					
						
							|  |  |  |         out = [] | 
					
						
							|  |  |  |         out.append("Dumping gcode input %d blocks" % ( | 
					
						
							|  |  |  |             len(self.input_log),)) | 
					
						
							|  |  |  |         for eventtime, data in self.input_log: | 
					
						
							|  |  |  |             out.append("Read %f: %s" % (eventtime, repr(data))) | 
					
						
							|  |  |  |         out.append( | 
					
						
							|  |  |  |             "gcode state: absolute_coord=%s absolute_extrude=%s" | 
					
						
							|  |  |  |             " base_position=%s last_position=%s homing_position=%s" | 
					
						
							|  |  |  |             " speed_factor=%s extrude_factor=%s speed=%s" % ( | 
					
						
							|  |  |  |                 self.absolute_coord, self.absolute_extrude, | 
					
						
							|  |  |  |                 self.base_position, self.last_position, self.homing_position, | 
					
						
							|  |  |  |                 self.speed_factor, self.extrude_factor, self.speed)) | 
					
						
							|  |  |  |         logging.info("\n".join(out)) | 
					
						
							|  |  |  |     def _handle_shutdown(self): | 
					
						
							|  |  |  |         if not self.is_printer_ready: | 
					
						
							|  |  |  |             return | 
					
						
							|  |  |  |         self.is_printer_ready = False | 
					
						
							|  |  |  |         self._dump_debug() | 
					
						
							|  |  |  |         if self.is_fileinput: | 
					
						
							|  |  |  |             self.printer.request_exit('error_exit') | 
					
						
							|  |  |  |     m112_r = re.compile('^(?:[nN][0-9]+)?\s*[mM]112(?:\s|$)') | 
					
						
							|  |  |  |     def _process_data(self, eventtime): | 
					
						
							|  |  |  |         # Read input, separate by newline, and add to pending_commands | 
					
						
							|  |  |  |         try: | 
					
						
							|  |  |  |             data = os.read(self.fd, 4096) | 
					
						
							|  |  |  |         except os.error: | 
					
						
							|  |  |  |             logging.exception("Read g-code") | 
					
						
							|  |  |  |             return | 
					
						
							|  |  |  |         self.input_log.append((eventtime, data)) | 
					
						
							|  |  |  |         self.bytes_read += len(data) | 
					
						
							|  |  |  |         lines = data.split('\n') | 
					
						
							|  |  |  |         lines[0] = self.partial_input + lines[0] | 
					
						
							|  |  |  |         self.partial_input = lines.pop() | 
					
						
							|  |  |  |         pending_commands = self.pending_commands | 
					
						
							|  |  |  |         pending_commands.extend(lines) | 
					
						
							|  |  |  |         self.pipe_is_active = True | 
					
						
							|  |  |  |         # Special handling for debug file input EOF | 
					
						
							|  |  |  |         if not data and self.is_fileinput: | 
					
						
							|  |  |  |             if not self.is_processing_data: | 
					
						
							|  |  |  |                 self.reactor.unregister_fd(self.fd_handle) | 
					
						
							|  |  |  |                 self.fd_handle = None | 
					
						
							|  |  |  |                 self.gcode.request_restart('exit') | 
					
						
							|  |  |  |             pending_commands.append("") | 
					
						
							|  |  |  |         # Handle case where multiple commands pending | 
					
						
							|  |  |  |         if self.is_processing_data or len(pending_commands) > 1: | 
					
						
							|  |  |  |             if len(pending_commands) < 20: | 
					
						
							|  |  |  |                 # Check for M112 out-of-order | 
					
						
							|  |  |  |                 for line in lines: | 
					
						
							|  |  |  |                     if self.m112_r.match(line) is not None: | 
					
						
							|  |  |  |                         self.cmd_M112(None) | 
					
						
							|  |  |  |             if self.is_processing_data: | 
					
						
							|  |  |  |                 if len(pending_commands) >= 20: | 
					
						
							|  |  |  |                     # Stop reading input | 
					
						
							|  |  |  |                     self.reactor.unregister_fd(self.fd_handle) | 
					
						
							|  |  |  |                     self.fd_handle = None | 
					
						
							|  |  |  |                 return | 
					
						
							|  |  |  |         # Process commands | 
					
						
							|  |  |  |         self.is_processing_data = True | 
					
						
							|  |  |  |         while pending_commands: | 
					
						
							|  |  |  |             self.pending_commands = [] | 
					
						
							|  |  |  |             with self.gcode_mutex: | 
					
						
							|  |  |  |                 self.gcode._process_commands(pending_commands) | 
					
						
							|  |  |  |             pending_commands = self.pending_commands | 
					
						
							|  |  |  |         self.is_processing_data = False | 
					
						
							|  |  |  |         if self.fd_handle is None: | 
					
						
							|  |  |  |             self.fd_handle = self.reactor.register_fd(self.fd, | 
					
						
							|  |  |  |                                                       self._process_data) | 
					
						
							|  |  |  |     def _respond_raw(self, msg): | 
					
						
							|  |  |  |         if self.pipe_is_active: | 
					
						
							|  |  |  |             try: | 
					
						
							|  |  |  |                 os.write(self.fd, msg+"\n") | 
					
						
							|  |  |  |             except os.error: | 
					
						
							|  |  |  |                 logging.exception("Write g-code response") | 
					
						
							|  |  |  |                 self.pipe_is_active = False | 
					
						
							|  |  |  |     def stats(self, eventtime): | 
					
						
							|  |  |  |         return False, "gcodein=%d" % (self.bytes_read,) | 
					
						
							| 
									
										
										
										
											2020-08-04 15:49:40 -04:00
										 |  |  | 
 | 
					
						
							|  |  |  | def add_early_printer_objects(printer): | 
					
						
							|  |  |  |     printer.add_object('gcode', GCodeParser(printer)) | 
					
						
							| 
									
										
										
										
											2020-08-04 16:32:19 -04:00
										 |  |  |     printer.add_object('gcode_io', GCodeIO(printer)) |