27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
|
#import "OFInvalidArgumentException.h"
#import "OFNotImplementedException.h"
#import "OFOutOfMemoryException.h"
#import "OFOutOfRangeException.h"
#import "macros.h"
@implementation OFFloatMatrix
+ matrixWithRows: (size_t)rows
columns: (size_t)columns
{
return [[[self alloc] initWithRows: rows
columns: columns] autorelease];
}
|
>
>
>
>
>
>
>
>
|
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
|
#import "OFInvalidArgumentException.h"
#import "OFNotImplementedException.h"
#import "OFOutOfMemoryException.h"
#import "OFOutOfRangeException.h"
#import "macros.h"
static Class floatVector = Nil;
@implementation OFFloatMatrix
+ (void)initialize
{
if (self == [OFFloatMatrix class])
floatVector = [OFFloatVector class];
}
+ matrixWithRows: (size_t)rows
columns: (size_t)columns
{
return [[[self alloc] initWithRows: rows
columns: columns] autorelease];
}
|
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
|
}
- (void)translateWithVector: (OFFloatVector*)vector
{
OFFloatMatrix *translation;
float *cArray;
if (rows != columns || [vector dimension] != rows - 1)
@throw [OFInvalidArgumentException newWithClass: isa
selector: _cmd];
cArray = [vector cArray];
translation = [[OFFloatMatrix alloc] initWithRows: rows
columns: columns];
memcpy(translation->data + (columns - 1) * rows, cArray,
(rows - 1) * sizeof(float));
@try {
[self multiplyWithMatrix: translation];
} @finally {
[translation release];
}
}
- (void)scaleWithVector: (OFFloatVector*)vector
{
OFFloatMatrix *scale;
float *cArray;
size_t i, j;
if (rows != columns || [vector dimension] != rows - 1)
@throw [OFInvalidArgumentException newWithClass: isa
selector: _cmd];
cArray = [vector cArray];
scale = [[OFFloatMatrix alloc] initWithRows: rows
columns: columns];
|
|
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
>
|
>
|
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
|
}
- (void)translateWithVector: (OFFloatVector*)vector
{
OFFloatMatrix *translation;
float *cArray;
if (rows != columns || vector->isa != floatVector ||
vector->dimension != rows - 1)
@throw [OFInvalidArgumentException newWithClass: isa
selector: _cmd];
cArray = [vector cArray];
translation = [[OFFloatMatrix alloc] initWithRows: rows
columns: columns];
memcpy(translation->data + (columns - 1) * rows, cArray,
(rows - 1) * sizeof(float));
@try {
[self multiplyWithMatrix: translation];
} @finally {
[translation release];
}
}
- (void)rotateWithVector: (OFFloatVector*)vector
angle: (float)angle
{
OFFloatMatrix *rotation;
float n[3], m, angleCos, angleSin;
if (rows != 4 || columns != 4 || vector->isa != floatVector ||
vector->dimension != 3)
@throw [OFInvalidArgumentException newWithClass: isa
selector: _cmd];
n[0] = vector->data[0];
n[1] = vector->data[1];
n[2] = vector->data[2];
m = sqrtf(n[0] * n[0] + n[1] * n[1] + n[2] * n[2]);
if (m != 1.0) {
n[0] /= m;
n[1] /= m;
n[2] /= m;
}
angle = (float)(angle * M_PI / 180.0f);
angleCos = cosf(angle);
angleSin = sinf(angle);
rotation = [[OFFloatMatrix alloc] initWithRows: rows
columns: columns];
rotation->data[0] = angleCos + n[0] * n[0] * (1 - angleCos);
rotation->data[1] = n[1] * n[0] * (1 - angleCos) + n[2] * angleSin;
rotation->data[2] = n[2] * n[0] * (1 - angleCos) - n[1] * angleSin;
rotation->data[4] = n[0] * n[1] * (1 - angleCos) - n[2] * angleSin;
rotation->data[5] = angleCos + n[1] * n[1] * (1 - angleCos);
rotation->data[6] = n[2] * n[1] * (1 - angleCos) + n[0] * angleSin;
rotation->data[8] = n[0] * n[2] * (1 - angleCos) + n[1] * angleSin;
rotation->data[9] = n[1] * n[2] * (1 - angleCos) - n[0] * angleSin;
rotation->data[10] = angleCos + n[2] * n[2] * (1 - angleCos);
@try {
[self multiplyWithMatrix: rotation];
} @finally {
[rotation release];
}
}
- (void)scaleWithVector: (OFFloatVector*)vector
{
OFFloatMatrix *scale;
float *cArray;
size_t i, j;
if (rows != columns || vector->isa != floatVector ||
vector->dimension != rows - 1)
@throw [OFInvalidArgumentException newWithClass: isa
selector: _cmd];
cArray = [vector cArray];
scale = [[OFFloatMatrix alloc] initWithRows: rows
columns: columns];
|