42 lines
1.1 KiB
TypeScript
42 lines
1.1 KiB
TypeScript
import * as GA from "./ga";
|
|
import { Line, Direction, Point, Transform } from "./ga";
|
|
import * as GADirection from "./gadirections";
|
|
|
|
/**
|
|
* TODO: docs
|
|
*/
|
|
|
|
export const rotation = (pivot: Point, angle: number): Transform =>
|
|
GA.add(GA.mul(pivot, Math.sin(angle / 2)), Math.cos(angle / 2));
|
|
|
|
export const translation = (direction: Direction): Transform => [
|
|
1,
|
|
0,
|
|
0,
|
|
0,
|
|
-(0.5 * direction[5]),
|
|
0.5 * direction[4],
|
|
0,
|
|
0,
|
|
];
|
|
|
|
export const translationOrthogonal = (
|
|
direction: Direction,
|
|
distance: number,
|
|
): Transform => {
|
|
const scale = 0.5 * distance;
|
|
return [1, 0, 0, 0, scale * direction[4], scale * direction[5], 0, 0];
|
|
};
|
|
|
|
export const translationAlong = (line: Line, distance: number): Transform =>
|
|
GA.add(GA.mul(GADirection.orthogonalToLine(line), 0.5 * distance), 1);
|
|
|
|
export const compose = (motor1: Transform, motor2: Transform): Transform =>
|
|
GA.mul(motor2, motor1);
|
|
|
|
export const apply = (
|
|
motor: Transform,
|
|
nvector: Point | Direction | Line,
|
|
): Point | Direction | Line =>
|
|
GA.normalized(GA.mul(GA.mul(motor, nvector), GA.reverse(motor)));
|