forked from HQU-gxy/camera-extrinsic-play
160 lines
5.1 KiB
TypeScript
160 lines
5.1 KiB
TypeScript
import { Grid, useBVH, useGLTF, CameraControls, AccumulativeShadows, OrbitControls, Stats } from '@react-three/drei'
|
|
import { Camera, Canvas, useFrame, useThree, useLoader } from '@react-three/fiber'
|
|
import * as THREE from 'three'
|
|
import { FontLoader } from 'three/addons/loaders/FontLoader.js'
|
|
import { TextGeometry } from 'three/addons/geometries/TextGeometry.js'
|
|
import HelvetikerRegular from "three/examples/fonts/helvetiker_regular.typeface.json"
|
|
import { useEffect, useRef, useState, JSX } from 'react'
|
|
|
|
const THREE_ADDONS = {
|
|
FontLoader,
|
|
TextGeometry,
|
|
} as const
|
|
|
|
|
|
const DEFAULT_NEAR = 0.1
|
|
const DEFAULT_FAR = 1
|
|
const CAMERA_EXTRINSIC_MATRIX_MAP: Record<string, number[]> = {
|
|
"AE_01": [
|
|
0.2321047, -0.97264263, -0.0096808, -0.96323585, 0.06882254,
|
|
0.02634936, -0.99728089, 0.03661007, 0.97025299, 0.23080732,
|
|
0.07305554, 3.34933242, 0., 0., 0.,
|
|
1.
|
|
],
|
|
"AE_1A": [
|
|
0.93194049, -0.35571886, -0.07036343, -0.92123075, 0.01084819,
|
|
0.22131041, -0.97514308, 0.24922173, 0.36244895, 0.908012,
|
|
0.21010704, 4.87284891, 0., 0., 0.,
|
|
1.
|
|
],
|
|
"AE_08": [
|
|
0.66806102, -0.74355508, -0.02864123, -1.10173496, 0.05931037,
|
|
0.09157787, -0.99403007, 0.26760438, 0.74173901, 0.66237402,
|
|
0.10528013, 6.92372493, 0., 0., 0.,
|
|
1.
|
|
]
|
|
} as const
|
|
const CAMERA_INTRINSIC_MATRIX_MAP: Record<string, number[]> = {
|
|
"AE_01": [
|
|
1806.82137617, 0., 1230.53175624, 0.,
|
|
1809.75580378, 766.36204406, 0., 0.,
|
|
1.
|
|
],
|
|
"AE_1A": [
|
|
3467.39715751, 0., 1000.62548655, 0.,
|
|
3473.7168112, 831.64048503, 0., 0.,
|
|
1.
|
|
],
|
|
"AE_08": [
|
|
2785.43931794, 0., 1254.98272372, 0.,
|
|
2788.10437965, 738.82985324, 0., 0.,
|
|
1.
|
|
]
|
|
} as const
|
|
|
|
const IMAGE_WIDTH = 2560
|
|
const IMAGE_HEIGHT = 1440
|
|
|
|
const intrinsicToFov = (intrinsic: number[], image_size: { width: number, height: number }) => {
|
|
console.assert(intrinsic.length === 9, "intrinsic must be a 3x3 matrix")
|
|
const fx = intrinsic[0]
|
|
const fy = intrinsic[4]
|
|
const cx = intrinsic[2]
|
|
const cy = intrinsic[5]
|
|
// in degrees
|
|
const fov_x = 2 * Math.atan(image_size.width / (2 * fx)) * (180 / Math.PI)
|
|
const fov_y = 2 * Math.atan(image_size.height / (2 * fy)) * (180 / Math.PI)
|
|
return { fov_x, fov_y }
|
|
}
|
|
|
|
const Scene = () => {
|
|
function Floor() {
|
|
return (
|
|
<mesh rotation-x={-Math.PI / 2} position-y={-0.05} receiveShadow>
|
|
<planeGeometry args={[15, 15]} />
|
|
<meshStandardMaterial color="#ccc" />
|
|
</mesh>
|
|
)
|
|
}
|
|
const Axes = () => {
|
|
return <axesHelper args={[15]} />
|
|
}
|
|
interface CameraViewFromExtrinsicProps {
|
|
extrinsic: number[]
|
|
aspect?: number
|
|
name?: string
|
|
near?: number
|
|
far?: number
|
|
fov?: number
|
|
textSize?: number
|
|
}
|
|
// https://threejs.org/docs/#examples/en/loaders/FontLoader
|
|
// https://www.ilyameerovich.com/simple-3d-text-meshes-in-three-js/
|
|
|
|
const CameraViewFromExtrinsic = ({ extrinsic, name, near, far, fov, textSize, aspect }: CameraViewFromExtrinsicProps) => {
|
|
const font = new FontLoader().parse(HelvetikerRegular)
|
|
const camera = new THREE.PerspectiveCamera(fov ?? 60, aspect ?? 4 / 3, near ?? DEFAULT_NEAR, far ?? DEFAULT_FAR)
|
|
const helper = <cameraHelper args={[camera]} />
|
|
// @ts-expect-error 16 elements
|
|
camera.applyMatrix4(new THREE.Matrix4(...extrinsic))
|
|
let text: JSX.Element | null = null
|
|
if (name) {
|
|
// https://github.com/pmndrs/react-three-fiber/discussions/832
|
|
const geo = new THREE_ADDONS.TextGeometry(name ?? "", { font, size: textSize ?? 0.1, depth: 0.001 })
|
|
|
|
// Extract camera position from extrinsic matrix
|
|
const matrix = new THREE.Matrix4()
|
|
// @ts-expect-error 16 elements
|
|
matrix.set(...extrinsic)
|
|
const position = new THREE.Vector3()
|
|
position.setFromMatrixPosition(matrix)
|
|
|
|
// Create text without applying camera matrix transformation
|
|
text = (
|
|
<mesh position={position}>
|
|
<primitive object={geo} />
|
|
<meshStandardMaterial color="black" />
|
|
</mesh>
|
|
)
|
|
}
|
|
return (
|
|
<group>
|
|
{text}
|
|
<primitive object={camera} />
|
|
{helper}
|
|
</group>
|
|
)
|
|
}
|
|
|
|
return (
|
|
// Note that we don't need to import anything, All three.js objects will be treated
|
|
// as native JSX elements, just like you can just write <div /> or <span /> in
|
|
// regular ReactDOM. The general rule is that Fiber components are available under
|
|
// the camel-case version of their name in three.js.
|
|
<>
|
|
<CameraControls />
|
|
{/* <OrbitControls /> */}
|
|
<ambientLight intensity={0.05} />
|
|
<directionalLight castShadow position={[3.3, 6, 4.4]} intensity={5} />
|
|
<Floor />
|
|
{Object.entries(CAMERA_EXTRINSIC_MATRIX_MAP).map(([key, value]) => {
|
|
const intrinsic = CAMERA_INTRINSIC_MATRIX_MAP[key]
|
|
const fov = intrinsicToFov(intrinsic, { width: IMAGE_WIDTH, height: IMAGE_HEIGHT })
|
|
return <CameraViewFromExtrinsic key={key} name={key} extrinsic={value} fov={fov.fov_x} aspect={IMAGE_WIDTH / IMAGE_HEIGHT} />
|
|
})}
|
|
<Axes />
|
|
<Stats />
|
|
</>
|
|
)
|
|
}
|
|
|
|
function App() {
|
|
return (
|
|
<Canvas shadows style={{ background: "#e9e9e9", width: "100vw", height: "100vh" }}>
|
|
<Scene />
|
|
</Canvas>
|
|
)
|
|
}
|
|
|
|
export default App
|