00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012 #include <stdio.h>
00013 #include <math.h>
00014 #include <AR/matrix.h>
00015
00016 int arMatrixUnit(ARMat *unit)
00017 {
00018 int r, c;
00019
00020 if(unit->row != unit->clm) return -1;
00021
00022 for(r = 0; r < unit->row; r++) {
00023 for(c = 0; c < unit->clm; c++) {
00024 if(r == c) {
00025 ARELEM0(unit, r, c) = 1.0;
00026 }
00027 else {
00028 ARELEM0(unit, r, c) = 0.0;
00029 }
00030 }
00031 }
00032
00033 return 0;
00034 }