MOOS 0.2375
|
00001 00002 // 00003 // MOOS - Mission Oriented Operating Suite 00004 // 00005 // A suit of Applications and Libraries for Mobile Robotics Research 00006 // Copyright (C) 2001-2005 Massachusetts Institute of Technology and 00007 // Oxford University. 00008 // 00009 // This software was written by Paul Newman at MIT 2001-2002 and Oxford 00010 // University 2003-2005. email: pnewman@robots.ox.ac.uk. 00011 // 00012 // This file is part of a MOOS Utility Component. 00013 // 00014 // This program is free software; you can redistribute it and/or 00015 // modify it under the terms of the GNU General Public License as 00016 // published by the Free Software Foundation; either version 2 of the 00017 // License, or (at your option) any later version. 00018 // 00019 // This program is distributed in the hope that it will be useful, 00020 // but WITHOUT ANY WARRANTY; without even the implied warranty of 00021 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 00022 // General Public License for more details. 00023 // 00024 // You should have received a copy of the GNU General Public License 00025 // along with this program; if not, write to the Free Software 00026 // Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 00027 // 02111-1307, USA. 00028 // 00030 #ifdef _WIN32 00031 #pragma warning(disable : 4786) 00032 #endif 00033 00034 #include "SimGlobalHelper.h" 00035 #include <MOOSGenLib/MOOSGenLib.h> 00036 #ifndef PI 00037 #define PI 3.141592653589793 00038 #endif 00039 00040 void MOOSTraceMatrix(Matrix & Mat,const char * Str) 00041 { 00042 00043 int nRows = Mat.Nrows(); 00044 int nCols = Mat.Ncols(); 00045 00046 MOOSTrace("Matrix %s : [%d x %d]\n",Str, nRows, nCols); 00047 00048 for ( int i = 0; i<nRows; i++ ) 00049 { 00050 for ( int j = 0;j<nCols; j++ ) 00051 { 00052 MOOSTrace("%09.5f ", Mat.element(i,j) ); 00053 } 00054 MOOSTrace(" \n"); 00055 } 00056 00057 } 00058