octave_packages/quaternion-2.0.0/@quaternion/blkdiag.m

   1 ## Copyright (C) 2011   Lukas F. Reichlin
   2 ##
   3 ## This program is free software: you can redistribute it and/or modify
   4 ## it under the terms of the GNU General Public License as published by
   5 ## the Free Software Foundation, either version 3 of the License, or
   6 ## (at your option) any later version.
   7 ##
   8 ## This program is distributed in the hope that it will be useful,
   9 ## but WITHOUT ANY WARRANTY; without even the implied warranty of
  10 ## MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  11 ## GNU General Public License for more details.
  12 ##
  13 ## You should have received a copy of the GNU General Public License
  14 ## along with this program.  If not, see <http://www.gnu.org/licenses/>.
  15
  16 ## -*- texinfo -*-
  17 ## @deftypefn {Function File} {@var{q} =} blkdiag (@var{q1}, @var{q2}, @dots{})
  18 ## Block-diagonal concatenation of quaternions.
  19 ## @end deftypefn
  20
  21
  22 ## Author: Lukas Reichlin <lukas.reichlin@gmail.com>
  23 ## Created: December 2011
  24 ## Version: 0.1
  25
  26 function q = blkdiag (varargin)
  27
  28   tmp = cellfun (@quaternion, varargin);  # uniformoutput = true !
  29
  30   w = blkdiag (tmp.w);
  31   x = blkdiag (tmp.x);
  32   y = blkdiag (tmp.y);
  33   z = blkdiag (tmp.z);
  34
  35   q = quaternion (w, x, y, z);
  36
  37 endfunction
  38
  39
  40 %!shared C, D
  41 %! Aw = [2, 6; 10, 14];
  42 %! Ax = [3, 7; 11, 15];
  43 %! Ay = [4, 8; 12, 16];
  44 %! Az = [5, 9; 13, 17];
  45 %! A = quaternion (Aw, Ax, Ay, Az);
  46 %!
  47 %! Bw = [2, 6, 10; 14, 18, 22];
  48 %! Bx = [3, 7, 11; 15, 19, 23];
  49 %! By = [4, 8, 12; 16, 20, 24];
  50 %! Bz = [5, 9, 13; 17, 21, 25];
  51 %! B = quaternion (Bw, Bx, By, Bz);
  52 %!
  53 %! C = blkdiag (A, B);
  54 %!
  55 %! Dw = blkdiag (Aw, Bw);
  56 %! Dx = blkdiag (Ax, Bx);
  57 %! Dy = blkdiag (Ay, By);
  58 %! Dz = blkdiag (Az, Bz);
  59 %! D = quaternion (Dw, Dx, Dy, Dz);
  60 %!assert (C == D);