def readline(self):
while (self.baudrateError):
if (self._baudrate != self.baudrate):
self.write("M105")
return ''
try:
s = self.outgoing.get_nowait()
self._logger.debug("readline: %s" % s)
return s
except Queue.Empty:
pass
s = gpx.readnext()
timeout = self.timeout
append_later = None
if gpx.waiting():
append_later = s
timeout = 2
else:
self._append(s)
try:
s = self.outgoing.get(timeout=timeout)
self._logger.debug("readline: %s" % s)
return s
except Queue.Empty:
if append_later is not None:
self._append(append_later)
self._logger.debug("timeout")
pass
return ''
def readline(self):
try:
while (self.baudrateError):
if (self._baudrate != self.baudrate):
gpx.write("M105")
return ''
try:
s = self.outgoing.get_nowait()
self._logger.debug("readline: %s" % s)
return s
except Queue.Empty:
pass
s = gpx.readnext()
timeout = self.timeout
append_later = None
if gpx.waiting():
append_later = s
timeout = 2
else:
self._append(s)
while True:
try:
s = self.outgoing.get(timeout=timeout)
if append_later is not None:
self._append(s)
s = append_later
self._logger.debug("readline: %s" % s)
return s
except Queue.Empty:
self._logger.debug("timeout")
if append_later is None:
return ''
self._append(append_later)
append_later = None
except gpx.CancelBuild:
self._bot_reports_build_cancelled()
return '// echo: build cancelled'
def readline(self):
try:
while self.baudrateError:
if self._baudrate != self.baudrate:
gpx.write("M105")
return ""
try:
s = self.outgoing.get_nowait()
self._logger.debug("readline: %s" % s)
return s
except Queue.Empty:
pass
s = gpx.readnext()
timeout = self.timeout
append_later = None
if gpx.waiting():
append_later = s
timeout = 2
else:
self._append(s)
while True:
try:
s = self.outgoing.get(timeout=timeout)
if append_later is not None:
self._append(s)
s = append_later
self._logger.debug("readline: %s" % s)
return s
except Queue.Empty:
self._logger.debug("timeout")
if append_later is None:
return ""
self._append(append_later)
append_later = None
except gpx.CancelBuild:
self._bot_reports_build_cancelled()
return "// echo: build cancelled"
dB = pos[axis]-cornerB[axis]
if fabs(dA) < fabs(dist):
dist = dA
closest = axis
if fabs(dB) < fabs(dist):
dist = dB
closest = axis
outside = outside - 1
if closest > -1 and outside == 0:
force[closest] = -stiffness*dist;
print_pos = [(a) * 200 for a in avg_pos]
print_pos = (print_pos[0]) * 2, (-print_pos[2] + 30) * 2, -print_pos[1]
if not gpx.waiting():
gcode = 'G1 X{:3.3f} Y{:3.3f} Z{:3.3f} F9999999'.format(*print_pos)
print gcode
gpx.write(gcode)
import time
time.sleep(0.03)
force = [0, 0, 0]
force_fv.x = force[0]
force_fv.y = force[1]
force_fv.z = force[2]
fdd.setForces(force_fv)
