diff options
Diffstat (limited to 'examples/point_triangle_collision')
| -rw-r--r-- | examples/point_triangle_collision/main.lua | 122 |
1 files changed, 122 insertions, 0 deletions
diff --git a/examples/point_triangle_collision/main.lua b/examples/point_triangle_collision/main.lua new file mode 100644 index 0000000..b2cbc29 --- /dev/null +++ b/examples/point_triangle_collision/main.lua @@ -0,0 +1,122 @@ +package.path = package.path..";"..RL_GetBasePath().."../resources/lib/?.lua" + +util = require "utillib" +Vec2 = require "vector2" +Vec3 = require "vector3" + +local MOVE_SPEED = 0.5 + +local monitor = 0 +local camera = -1 +local texture = -1 +local tri = { + a = Vec3:new( 0, 0, 0 ), + -- a = Vec3:new( 0, 1, 0 ), + b = Vec3:new( 0, 0, 2 ), + c = Vec3:new( 1, 0, 0 ), + normal = Vec3:new( 0, 0, 0 ), +} +local point = { + pos = Vec3:new( 0.2, 0.3, 0.2 ), + radius = 0.05, + lineLen = 0.5, + color = RED, +} + +local debugText = "" + +local function calcNormal( tri ) + tri.normal = Vec3:new( RL_Vector3Normalize( RL_Vector3CrossProduct( tri.b - tri.a, tri.c - tri.a ) ) ) +end + +function init() + local mPos = RL_GetMonitorPosition( monitor ) + local mSize = RL_GetMonitorSize( monitor ) + local winSize = { 1920, 1080 } + + RL_SetWindowState( FLAG_WINDOW_RESIZABLE ) + RL_SetWindowPosition( { mPos[1] + mSize[1] / 2 - winSize[1] / 2, mPos[2] + mSize[2] / 2 - winSize[2] / 2 } ) + RL_SetWindowSize( winSize ) + camera = RL_CreateCamera3D() + RL_SetCamera3DPosition( camera, { 0, 1, 2 } ) + RL_SetCamera3DTarget( camera, { 0, 0, 0 } ) + RL_SetCamera3DUp( camera, { 0, 2, 0 } ) + RL_SetCamera3DMode( camera, CAMERA_FREE ) + + calcNormal( tri ) +end + +local function checkCollisionPointTriangle( p, a, b, c, n ) + local result = Vec3:new( 0, 0, 0 ) + + local v0 = Vec3:new( b.x - a.x, b.y - a.y, b.z - a.z ) -- Vector3Subtract( b, a ) + local v1 = Vec3:new( c.x - a.x, c.y - a.y, c.z - a.z ) -- Vector3Subtract( c, a ) + local v2 = Vec3:new( p.x - a.x, p.y - a.y, p.z - a.z ) -- Vector3Subtract( p, a ) + local d00 = v0.x * v0.x + v0.y * v0.y + v0.z * v0.z -- Vector3DotProduct( v0, v0 ) + local d01 = v0.x * v1.x + v0.y * v1.y + v0.z * v1.z -- Vector3DotProduct( v0, v1 ) + local d11 = v1.x * v1.x + v1.y * v1.y + v1.z * v1.z -- Vector3DotProduct( v1, v1 ) + local d20 = v2.x * v0.x + v2.y * v0.y + v2.z * v0.z -- Vector3DotProduct( v2, v0 ) + local d21 = v2.x * v1.x + v2.y * v1.y + v2.z * v1.z -- Vector3DotProduct( v2, v1 ) + + local denom = d00 * d11 - d01 * d01 + local distance = v2.x * n.x + v2.y * n.y + v2.z * n.z -- Vector3DotProduct( v2, n ) + + debugText = debugText.."distance "..distance.."\n" + debugText = debugText.."v0 "..v0.x..", "..v0.y..", "..v0.z.."\n" + debugText = debugText.."v1 "..v1.x..", "..v1.y..", "..v1.z.."\n" + debugText = debugText.."v2 "..v2.x..", "..v2.y..", "..v2.z.."\n" + + result.y = ( d11 * d20 - d01 * d21) / denom + result.z = ( d00 * d21 - d01 * d20) / denom + result.x = 1.0 - ( result.z + result.y ) + + debugText = debugText.."result "..result.x..", "..result.y..", "..result.z.."\n" + + return 0.0 < result.x and 0.0 < result.y and 0.0 < result.z and distance < 0.0, distance +end + +function process( delta ) + debugText = "" + + if RL_IsKeyDown( string.byte( "D" ) ) then + point.pos.x = point.pos.x + MOVE_SPEED * delta + elseif RL_IsKeyDown( string.byte( "A" ) ) then + point.pos.x = point.pos.x - MOVE_SPEED * delta + end + if RL_IsKeyDown( string.byte( "S" ) ) then + point.pos.z = point.pos.z + MOVE_SPEED * delta + elseif RL_IsKeyDown( string.byte( "W" ) ) then + point.pos.z = point.pos.z - MOVE_SPEED * delta + end + if RL_IsKeyDown( string.byte( "R" ) ) then + point.pos.y = point.pos.y + MOVE_SPEED * delta + elseif RL_IsKeyDown( string.byte( "F" ) ) then + point.pos.y = point.pos.y - MOVE_SPEED * delta + end + + if checkCollisionPointTriangle( point.pos, tri.a, tri.b, tri.c, tri.normal ) then + point.color = RED + else + point.color = GREEN + end +end + +function draw() + RL_ClearBackground( { 100, 150, 100 } ) + RL_UpdateCamera3D( camera ) + + RL_BeginMode3D( camera ) + RL_DrawGrid( 8, 1 ) + RL_DrawTriangle3D( tri.a, tri.b, tri.c, { 200, 100, 100 } ) + + RL_DrawLine3D( { point.pos.x - point.lineLen, point.pos.y, point.pos.z }, + { point.pos.x + point.lineLen, point.pos.y, point.pos.z }, BLUE ) + RL_DrawLine3D( { point.pos.x, point.pos.y - point.lineLen, point.pos.z }, + { point.pos.x, point.pos.y + point.lineLen, point.pos.z }, BLUE ) + RL_DrawLine3D( { point.pos.x, point.pos.y, point.pos.z - point.lineLen }, + { point.pos.x, point.pos.y, point.pos.z + point.lineLen }, BLUE ) + RL_DrawSphereWires( point.pos, point.radius, 3, 8, point.color ) + RL_EndMode3D() + + RL_DrawText( 0, debugText, { 10, 10 }, 30, 4, WHITE ) +end |