gnewPlotter/painter.py at master · emv-dev/gnewPlotter · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
import sys
from printer import *
import numpy as np
from numpy import cos, sin,dot
from numpy import array, linspace
from scipy import misc
from time import sleep
import matplotlib.pyplot as plt
from PIL import Image
import time

current_milli_time = lambda: int(round(time.time() * 1000))
last_color = 0
#parameters
N = 15 #scanning radius
offset = array( (40,0) )
dipradius = 15 #(1/4 mm)
dipposition = [	array((0	,47)),
               	array((0	,135)),
               	array((0	,223)),
               	array((0	,311))
               	]
watertray = (510, 700)
length_til_dip = 50
diptime = 30000

hold_push = 500 #ms
hold_press = hold_push
hold_release = 400 #ms

step_delay = 0


pressed_ = False

def comp(A,B):
	return A == B
def clear(A):
	return not A
def setImage(M):
	global D
	D = M
def clean(r,n=4,drytime=500):
	moveto( (70, r[1]))
	moveto( (0, (watertray[0] + watertray[1])/2))
	press()
	for dummy in range(n):
		moveto( (25, watertray[0]) )
		moveto( (25, watertray[1]) )
	release()
	sleep(drytime/1000.)
	moveto( (70, watertray[1]))
	moveto( r )
def dip(r,dip):
	global pressed_, dipposition,last_color
	if last_color != dip:
		clean(r,n=10)
		last_color = dip
	moveto( dipposition[dip] + offset+offset)
	moveto( dipposition[dip])
	press(hold_push)
	release(hold_push);
	moveto( dipposition[dip] + offset)
	moveto(r)
def drawBorder():
	global D, offset
	home()
	press(300)
	moveto(D.shape + offset)
	moveto((0,0) + offset)
	release()

def gotonextpoint(r, o,color):
	global length_til_dip, diptime, hold_press,hold_push,hold_release
	global pressed_, D, pixc
	global D, N
	global pixc
	global left_spot,last_time
	r = array(r)
	o = array(o)
	if comp(D[r[0], r[1]], 0):
		D[r[0], r[1]] = clear(D[r[0],r[1]])
		if current_milli_time() - last_time > diptime:
			if color != -1:
				release(hold_release)
				dip(r+o, color)
			last_time = current_milli_time()

		moveto( array((r[1],r[0])) + o,utime_wait=step_delay)
		if not pressed_:
			press(hold_push)
			pressed_ = True
		if pressed_:
			press()
		#check adjacent pixels.
		for dy in xrange(0,2*N+1):
			for dx in xrange(-dy,dy):
				try:
					if comp(D[ r[0]+dx, r[1] + (-1)**dy*dy/2],0):
						gotonextpoint( (r[0] + dx, r[1]+(-1)**dy*dy/2), o, color)
						return
				except:
					pass
	return

def drawImage(color):
	global D, currpos, pressed_,left_spot,last_time,last_color
	sys.setrecursionlimit(10000000)
	dim = D.shape
	home()
	if color != -1:
		dip( currpos, color)
	last_time = current_milli_time()
	left_spot = currpos
	# while D.any():
	for j in xrange(dim[1]):
		for i in xrange(dim[0]):
			gotonextpoint( (i,j), offset, color)
			if pressed_:
				release(hold_release)
				pressed_ = False
	# savepower()