Add a useful package (from Source forge) for octave

[CreaPhase.git] / octave_packages / vrml-1.0.13 / vrml_transfo.m

diff --git a/octave_packages/vrml-1.0.13/vrml_transfo.m b/octave_packages/vrml-1.0.13/vrml_transfo.m
new file mode 100644 (file)
index 0000000..3560ec1
--- /dev/null
+++ b/octave_packages/vrml-1.0.13/vrml_transfo.m
@@ -0,0 +1,115 @@
+## Copyright (C) 2002 Etienne Grossmann <etienne@egdn.net>
+##
+## This program is free software; you can redistribute it and/or modify it under
+## the terms of the GNU General Public License as published by the Free Software
+## Foundation; either version 3 of the License, or (at your option) any later
+## version.
+##
+## This program is distributed in the hope that it will be useful, but WITHOUT
+## ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+## FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more
+## details.
+##
+## You should have received a copy of the GNU General Public License along with
+## this program; if not, see <http://www.gnu.org/licenses/>.
+
+##       v = vrml_transfo(s,t,r,c,d)
+##  
+## s : string of vrml code.
+## t : 3      Translation                          default : [0,0,0]
+## r : 3x3    Rotation matrix, or                  default : eye(3)
+##     3      Scaled rotation axis.
+## c : 3 or 1 Scale                                default : 1
+## d : string DEF name                             default : ''
+##
+## v : string v is s, enclosed in a Transform {} vrml node with
+##     rotation, translation and scale params given by r, t and c.
+##
+
+function v = vrml_transfo(s,t,r,c,DEF)
+
+## Hint : if s is "%s", you may later do v2 = sprintf (v,s2) which should be
+##        equal to  vrml_transfo (s2,etc)
+
+verbose = 0;
+## 
+t0 = [0;0;0];
+r0 = [1,0,0,0];
+c0 = [1;1;1];
+if nargin<2 || isnan (t), t = t0; end # Default translation
+if nargin<3 || isnan (r), r = r0; end # Default rotation
+if nargin<4 || isnan (c), c = c0; end # Default scale
+if nargin<5, DEF = ""; end
+
+if verbose > 1
+  if nargin > 1, printf ("vrml_transfo : t   = %s\n",sprintf ("%f ",t)); end
+  if nargin > 2, printf ("vrml_transfo : r   = %s\n",sprintf ("%f ",r)); end
+  if nargin > 3, printf ("vrml_transfo : c   = %s\n",sprintf ("%f ",c)); end
+  if nargin > 4, printf ("vrml_transfo : DEF = %s\n",DEF); end
+end
+t = t(:);
+c = c(:);
+## if nargin<4, s = "%s" ; end
+
+if prod(size(t)) != 3, error("t has %i elements, not 3",prod(size(t))); end
+
+
+if prod(size(c))==1, c = [c;c;c]; end
+
+if all(size(r) == 3)
+  if abs (det (r) - 1) > sqrt (eps), r2 = orth (r);
+  else                               r2 = r;
+  end
+  [axis,ang] = rotparams (r2);
+elseif prod(size(r)) == 4
+  ang = r(4);
+  axis = r(1:3);
+elseif prod(size(r)) == 3
+  ang = norm(r);
+  if abs(ang)>eps, 
+    axis = r/ang;
+  else
+    axis = [0,1,0]; ang = 0;
+  end
+else
+  error ("vrml_transfo : rotation should have size 3x3, 3 or 4\n");
+end
+if verbose,
+  printf (["vrml_transfo : %8.3f %8.3f %8.3f %8.3f\n",\
+          "               %8.3f %8.3f %8.3f\n"],\
+         axis,ang,t);
+  printf ("length of string is %i\n",prod(size(s)));
+end
+
+                               # Indent s by 4
+if length (s) && strcmp(s(prod(size(s))),"\n") # chomp
+  s = s(1:prod(size(s))-1) ;
+end
+## strrep is slow, as if it copied everything by hand. So don't indent.
+#  mytic() ;
+#  s = ["    ",strrep(s,"\n","\n    ")] ;
+#  mytic()
+if verbose, printf ("   done indenting s\n"); end
+
+sr = st = ss = sd = "";
+if abs (ang) > sqrt (eps)
+  sr = sprintf ("  rotation    %8.3f %8.3f %8.3f %8.3f\n",axis,ang);
+end
+if any (abs (t - t0)>sqrt (eps))
+  st = sprintf ("  translation %8.3f %8.3f %8.3f\n",t);
+end
+if any (abs (c - c0)>sqrt (eps))
+  ss = sprintf ("  scale       %8.3f %8.3f %8.3f\n",c);
+end
+if !isempty (DEF), sd = ["DEF ",DEF," "]; end 
+
+v = sprintf([sd,"Transform {\n",sr,st,ss,\
+            "  children [\n%s\n",\
+            "           ]\n",\
+            "}\n",\
+            ],\
+           s) ;
+## keyboard
+
+endfunction
+