home *** CD-ROM | disk | FTP | other *** search
/ Hackers Magazine 57 / CdHackersMagazineNr57.iso / Software / Multimedia / k3d-setup-0.7.11.0.exe / lib / site-packages / cgkit / bvhimport.py < prev    next >
Encoding:
Python Source  |  2007-01-11  |  5.9 KB  |  192 lines
  1. # ***** BEGIN LICENSE BLOCK *****
  2. # Version: MPL 1.1/GPL 2.0/LGPL 2.1
  3. #
  4. # The contents of this file are subject to the Mozilla Public License Version
  5. # 1.1 (the "License"); you may not use this file except in compliance with
  6. # the License. You may obtain a copy of the License at
  7. # http://www.mozilla.org/MPL/
  8. #
  9. # Software distributed under the License is distributed on an "AS IS" basis,
  10. # WITHOUT WARRANTY OF ANY KIND, either express or implied. See the License
  11. # for the specific language governing rights and limitations under the
  12. # License.
  13. #
  14. # The Original Code is the Python Computer Graphics Kit.
  15. #
  16. # The Initial Developer of the Original Code is Matthias Baas.
  17. # Portions created by the Initial Developer are Copyright (C) 2004
  18. # the Initial Developer. All Rights Reserved.
  19. #
  20. # Contributor(s):
  21. #
  22. # Alternatively, the contents of this file may be used under the terms of
  23. # either the GNU General Public License Version 2 or later (the "GPL"), or
  24. # the GNU Lesser General Public License Version 2.1 or later (the "LGPL"),
  25. # in which case the provisions of the GPL or the LGPL are applicable instead
  26. # of those above. If you wish to allow use of your version of this file only
  27. # under the terms of either the GPL or the LGPL, and not to allow others to
  28. # use your version of this file under the terms of the MPL, indicate your
  29. # decision by deleting the provisions above and replace them with the notice
  30. # and other provisions required by the GPL or the LGPL. If you do not delete
  31. # the provisions above, a recipient may use your version of this file under
  32. # the terms of any one of the MPL, the GPL or the LGPL.
  33. #
  34. # ***** END LICENSE BLOCK *****
  35. # $Id: bvhimport.py,v 1.1 2005/02/11 14:32:34 mbaas Exp $
  36.  
  37. from cgtypes import *
  38. from joint import Joint
  39. from valuetable import ValueTable
  40. import bvh
  41. import pluginmanager
  42. from sl import *
  43.  
  44. # BVHReader
  45. class BVHReader(bvh.BVHReader):
  46.     """Specialized BVH reader class.
  47.  
  48.     This class creates a hierarchy of joints and applies the motion to it.
  49.     """
  50.     
  51.     def __init__(self, filename):
  52.         bvh.BVHReader.__init__(self, filename)
  53.       
  54.  
  55.     def onHierarchy(self, root):
  56.         self.createSkeleton(root)
  57.         self.root = root
  58.  
  59.     def onMotion(self, frames, dt):
  60.         self.frames = frames
  61.         self.dt = dt
  62.         self.currentframe = 0
  63.  
  64.     def onFrame(self, values):
  65.         self.applyMotion(self.root, values)
  66.         self.currentframe += 1
  67.  
  68.     def applyMotion(self, node, values):
  69.         """Apply a motion sample to the skeleton.
  70.  
  71.         node is the current joint and values the joint angles for the
  72.         entire skeleton.
  73.         The method returns the remaining joint angles.
  74.         """
  75.  
  76.         t = self.currentframe*self.dt
  77.         
  78.         nc = len(node.channels)
  79.         vals = values[:nc]
  80.         pos = vec3()
  81.         pos_flag = False
  82.         for ch,v in zip(node.channels, vals):
  83.             if ch=="Xrotation":
  84.                 node.vtx.add(t, v)
  85.             elif ch=="Yrotation":
  86.                 node.vty.add(t, v)
  87.             elif ch=="Zrotation":
  88.                 node.vtz.add(t, v)
  89.             elif ch=="Xposition":
  90.                 pos.x = v
  91.                 pos_flag = True
  92.             elif ch=="Yposition":
  93.                 pos.y = v
  94.                 pos_flag = True
  95.             elif ch=="Zposition":
  96.                 pos.z = v
  97.                 pos_flag = True
  98.  
  99.         if pos_flag:
  100.             node.vtpos.add(t, pos)
  101.             
  102.         values = values[nc:]
  103.         for c in node.children:
  104.             values = self.applyMotion(c, values)
  105.         return values
  106.  
  107.     # createSkeleton
  108.     def createSkeleton(self, node, parent=None):
  109.         """Create the skeleton hierarchy.
  110.  
  111.         This method creates the skeleton recursively. Each invocation
  112.         creates one joint.
  113.         """
  114.         order = self.rotationOrder(node.channels)
  115.         # Create a new Joint object
  116.         j = Joint(name = node.name,
  117.                   pos = vec3(node.offset),
  118.                   rotationorder = order,
  119.                   parent = parent)
  120.         # Store the joint in the node so that later the motion can be applied
  121.         node.joint = j
  122.         
  123.         vtx = ValueTable(type="double")
  124.         vty = ValueTable(type="double")
  125.         vtz = ValueTable(type="double")
  126.         vtx.output_slot.connect(j.anglex_slot)
  127.         vty.output_slot.connect(j.angley_slot)
  128.         vtz.output_slot.connect(j.anglez_slot)
  129.         node.vtx = vtx
  130.         node.vty = vty
  131.         node.vtz = vtz
  132.         if node.isRoot():
  133.             vtpos = ValueTable(type="vec3")
  134.             vtpos.output_slot.connect(j.pos_slot)
  135.             node.vtpos = vtpos
  136.             
  137.         for c in node.children:
  138.             self.createSkeleton(c, j)
  139.  
  140.     # rotationOrder
  141.     def rotationOrder(self, channels):
  142.         """Determine rotation order string from the channel names.
  143.         """
  144.         res = ""
  145.         for c in channels:
  146.             if c[-8:]=="rotation":
  147.                 res += c[0]
  148.  
  149.         # Complete the order string if it doesn't already contain
  150.         # all three axes
  151.         m = { "":"XYZ",
  152.               "X":"XYZ", "Y":"YXZ", "Z":"ZXY",
  153.               "XY":"XYZ", "XZ":"XZY",
  154.               "YX":"YXZ", "YZ":"YZX",
  155.               "ZX":"ZXY", "ZY":"ZYX" }
  156.         if res in m:
  157.             res = m[res]
  158.         return res
  159.  
  160. ######################################################################
  161.  
  162. # BVHImporter
  163. class BVHImporter:
  164.  
  165.     _protocols = ["Import"]
  166.  
  167.     # extension
  168.     def extension():
  169.         """Return the file extensions for this format."""
  170.         return ["bvh"]
  171.     extension = staticmethod(extension)
  172.  
  173.     # description
  174.     def description(self):
  175.         """Return a short description for the file dialog."""
  176.         return "Biovision Hierarchical"
  177.     description = staticmethod(description)
  178.  
  179.     # importFile
  180.     def importFile(self, filename):
  181.         """Import a BVH file."""
  182.         
  183.         bvh = BVHReader(filename)
  184.         bvh.read()
  185.  
  186.  
  187. ######################################################################
  188.  
  189. # Register the Importer class as a plugin class
  190. pluginmanager.register(BVHImporter)
  191.  
  192.