# LightWave .lwo file loader

from math import *
from struct import *
from pyrit import Triangle, NormalVertex, Material
from vector import dot

def read_int4(f):
	return unpack('>i', f.read(4))[0]

def read_int2(f):
	return unpack('>h', f.read(2))[0]

def read_float4(f):
	return unpack('>f', f.read(4))[0]

def read_string(f):
	res = ''
	b = f.read(1)
	l = 1
	while ( b != '\0' ):
		res += b
		b = f.read(1)
		l += 1
	if (l % 2 != 0):
		f.read(1)
		l += 1
	return (res,l)

def read_chunk(f):
	ID = f.read(4)
	if (ID == ''):
		return ('',0)
	size = read_int4(f)
	return (ID, size)

def read_subchunk(f):
	ID = f.read(4)
	size = read_int2(f)
	return (ID, size)

def read_lwo(filename):
	points = []
	faces = []
	tags = []
	surfaces = []
	f = file(filename, 'rb')
	(ID,size) = read_chunk(f)
	form = f.read(4)
	if (ID != 'FORM' or form != 'LWOB'):
		print 'unknown format'
		return
	(ID,size) = read_chunk(f)
	while (ID != ''):
		#print ID,size
		if (ID == 'PNTS'):
			while (size > 0):
				p1 = read_float4(f)
				p2 = read_float4(f)
				p3 = read_float4(f)
				points.append((p1,p2,p3))
				size -= 12
		elif (ID == 'SRFS'):
			while (size > 0):
				(s,l) = read_string(f)
				size -= l
				tags.append(s)
		elif (ID == 'POLS'):
			while (size > 0):
				vertex_count = read_int2(f)
				size -= 2
				inds = []
				for i in range(vertex_count):
					index = read_int2(f)
					inds.append(index)
					size -= 2
				surf = read_int2(f)
				size -= 2
				if surf < 0:
					# detail polygons
					surf = abs(surf)
					count = read_int2(f)
					size -= 2
					# ... FIXME
				#print size, vertex_count
				if vertex_count >= 3:
					faces.append([inds[0], inds[1], inds[2], surf])
				i = 0
				while (vertex_count > 3):
					faces.append([inds[0], inds[2+i], inds[3+i], surf])
					vertex_count -= 1
					i += 1
		elif (ID == 'SURF'):
			(name,l) = read_string(f)
			size -= l
			surf = {}
			while (size > 0):
				(subID,subsize) = read_subchunk(f)
				size -= 6
				if (subID == 'COLR'):
					col = f.read(subsize)
					surf['color'] = (unpack('BBB',col[:3]))
				elif (subID == 'FLAG'):
					flags = read_int2(f)
					surf['luminous'] = (flags >> 0) & 1;
					surf['outline'] = (flags >> 1) & 1;
					surf['smooth'] = (flags >> 2) & 1;
					surf['color-highlights'] = (flags >> 3) & 1;
					surf['color-filter'] = (flags >> 4) & 1;
					surf['opaque-edge'] = (flags >> 5) & 1;
					surf['transparent-edge'] = (flags >> 6) & 1;
					surf['sharp-terminator'] = (flags >> 7) & 1;
					surf['double-sided'] = (flags >> 8) & 1;
					surf['additive'] = (flags >> 9) & 1;

				# Base Shading (float)
				elif (subID == 'VDIF'):
					surf['diffuse'] = read_float4(f)
				elif (subID == 'VSPC'):
					surf['specular'] = read_float4(f)
				elif (subID == 'VRFL'):
					surf['reflection'] = read_float4(f)
				elif (subID == 'VTRN'):
					surf['transparency'] = read_float4(f)

				# Base Shading (short)
				elif (subID == 'DIFF'):
					if not surf.has_key('diffuse'):
						surf['diffuse'] = read_int2(f)/255.
				elif (subID == 'SPEC'):
					if not surf.has_key('specular'):
						surf['specular'] = read_int2(f)/255.
				elif (subID == 'REFL'):
					if not surf.has_key('reflection'):
						surf['reflection'] = read_int2(f)/255.
				elif (subID == 'TRAN'):
					if not surf.has_key('transparency'):
						surf['transparency'] = read_int2(f)/255.

				elif (subID == 'RIND'):
					surf['refractive-index'] = read_float4(f)
				elif (subID == 'GLOS'):
					surf['glossiness'] = read_int2(f)
				elif (subID == 'SMAN'):
					surf['smoothing-max-angle'] = read_float4(f)
				else:
					print "Warning: SURF sub chunk", subID,"("+str(subsize),"B) ignored"
					f.read(subsize)
				size -= subsize
			surfaces.append(surf)
		else:
			print "Warning: chunk", ID,"("+str(size),"B) ignored"
			f.read(size)
		(ID,size) = read_chunk(f)
	return (points, faces, tags, surfaces)

def LoadLightwaveLwoFile(rt, filename, scale=(1,1,1), trans=(0,0,0)):
	if (type(scale) == float or type(scale) == int):
		scale = (scale,)*3
	(points, faces, tags, surfaces) = read_lwo(filename)

	vertices = []
	normals = []
	vertex_faces = []
	materials = []

	for surf in surfaces:
		mat = Material(colour=tuple(float(x)/255. for x in surf['color']))
		if surf.has_key('smooth'):
			mat.setSmooth(surf['smooth'])
		diff = 1.
		if surf.has_key('diffuse'):
			diff = surf['diffuse']
		spec = 0.
		if surf.has_key('specular'):
			spec = surf['specular']
		gloss = 1.0
		if surf.has_key('glossiness'):
			gloss = surf['glossiness']
		mat.setPhong(0.1, diff, spec, gloss)
		refl = 0.
		if surf.has_key('reflection'):
			refl = surf['reflection']
		mat.setReflectivity(refl)
		transp = 0.
		if surf.has_key('transparency'):
			transp = surf['transparency']
		rindex = 1.0
		if surf.has_key('refractive-index'):
			rindex = surf['refractive-index']
		mat.setTransmissivity(transp, rindex)
		materials.append(mat)

	for point in points:
		v0 = scale[0]*point[0] + trans[0]
		v1 = scale[1]*point[1] + trans[1]
		v2 = scale[2]*point[2] + trans[2]
		vertices.append(NormalVertex((v2,v1,v0)))
		normals.append([0.,0.,0.])
		vertex_faces.append([])

	for f in faces:
		for x in f[0:3]:
			vertex_faces[x].append(f)

	# interpolate normals at vertices
	num = 0
	for vfaces in vertex_faces:
		vert = vertices[num]
		edges = {}
		N = [0,0,0]
		for f in vfaces:
			for fvert in f[0:3]:
				if edges.has_key(str(fvert)):
					edges[str(fvert)].append(f)
				else:
					edges[str(fvert)] = [f]
		for f in vfaces:
			vv = [vertices[x] for x in f[0:3]]
			fN = Triangle(vv[0], vv[1], vv[2], materials[f[3]-1]).getNormal()
			for i in range(3):
				N[i] += fN[i]
			surf = surfaces[f[3]-1]
			if not surf.has_key('smoothing-max-angle'):
				continue
			fNvert = list(fN)
			Ncount = 1
			copy_vertex = False
			for fvert in f[0:3]:
				for ef in edges[str(fvert)]:
					if ef == f:
						continue
					# f - ref. face; ef - other face
					vv = [vertices[x] for x in ef[0:3]]
					efN = Triangle(vv[0], vv[1], vv[2], materials[ef[3]-1]).getNormal()
					d = dot(fN, efN)
					if d > 1:
						d = 1
					if d < -1:
						d = -1
					if acos(d) < surf['smoothing-max-angle']:
						for i in range(3):
							fNvert[i] += efN[i]
						Ncount += 1
					else:
						copy_vertex = True
			# here fNvert is normal for num'th vertex in face f
			if copy_vertex:
				for i in range(3):
					fNvert[i] /= Ncount
				new_vert = NormalVertex(vert)
				new_vert.setNormal(tuple(fNvert))
				f.append(f[0])
				f.append(f[1])
				f.append(f[2])
				vertices.append(new_vert)
				for i in range(3):
					if f[i] == num:
						f[i+4] = len(vertices)-1
		if (len(vfaces) > 0):
			for i in range(3):
				N[i] /= len(vfaces)
		vertices[num].setNormal(tuple(N))
		num += 1

	for f in faces:
		if len(f) > 4:
			v = [vertices[x] for x in f[4:7]]
		else:
			v = [vertices[x] for x in f[0:3]]
		matidx = f[3]-1
		face = Triangle(v[0], v[1], v[2], materials[matidx])
		rt.addShape(face)

	return len(faces)