3940414243444546474849
public void setDirection(double angle) { Matrix3d mat = new Matrix3d(); mat.rotZ(angle); Vector3d tmp = new Vector3d(1, 0, 0); mat.transform(tmp); direction = new Vector2d(tmp.x, tmp.y); } public Vector2d getAcceleration() { return acceleration;
481482483484485486487488489490491
hMatrix.m20 = h13; // h31 = h13 hMatrix.m21 = h23; // h32 = h22 hMatrix.m22 = h33; hMatrix.invert(); Point3d check = new Point3d(b1, b2, b3); hMatrix.transform(check); System.err.println("check point = " + check.x+" " + check.y+" " + check.z); }