import sys, time, math
from OpenGL.GL import *
from OpenGL.GLU import *
from OpenGL.GLUT import *
from dmsgl import *
import trackd

prevTime = time.time()

trackd.init(4505)
object1 = WFObject('smallcow.obj')
object2 = WFObject('smallcow.obj')

def draw():
    glViewport(0,0,1024,768)
    glScissor(0,0,1024,768)
    drawView(0)
    glutSwapBuffers()

def drawView(offset):
    glClearColor(0, 0.3, 0.5, 0)
    glClear(GL_COLOR_BUFFER_BIT | GL_DEPTH_BUFFER_BIT)
    glMatrixMode(GL_PROJECTION)
    glLoadIdentity()
#    glOrtho(-5,5, 0,8, -10,10)
    gluPerspective(77, 10.0/8.0, 0.1, 100.0)
    glMatrixMode(GL_MODELVIEW)

    glLoadIdentity()
    glTranslate(offset * 0.2, -4, -10)

    glPushMatrix()
    wand = trackd.sensor(1)
    glTranslatef(wand[0], wand[1], wand[2])
    glRotatef(wand[4], 0, 1, 0)
    glRotatef(wand[3], 1, 0, 0)
    glRotatef(wand[5], 0, 0, 1)
    object1.draw()
    glPopMatrix()
    glPushMatrix()
    wand = trackd.sensor(2)
    glTranslatef(wand[0], wand[1], wand[2])
    glRotatef(wand[4], 0, 1, 0)
    glRotatef(wand[3], 1, 0, 0)
    glRotatef(wand[5], 0, 0, 1)
    glRotatef(90, 0, 1, 0)
    object2.draw()
    glPopMatrix()



def keyboard(key, x, y):
    if key == chr(27):
        sys.exit(0)

def specialkey(key,x,y):
    pass

def specialkeyUp(key,x,y):
    pass

def update():
    trackd.update()
    glutPostRedisplay()

glutInit([])
glutInitDisplayMode(GLUT_RGB | GLUT_DOUBLE | GLUT_DEPTH)
glutInitWindowSize(1024,768)
glutCreateWindow(sys.argv[0])
glutFullScreen()
glutDisplayFunc(draw)
glutKeyboardFunc(keyboard)
glutSpecialFunc(specialkey)
glutSpecialUpFunc(specialkeyUp)
glutIgnoreKeyRepeat(1)
glutIdleFunc(update)
glEnable(GL_LIGHTING)
glEnable(GL_LIGHT0)
glEnable(GL_DEPTH_TEST)
glEnable(GL_NORMALIZE)
glEnable(GL_SCISSOR_TEST)
glutMainLoop()