vec3.fs

[undefined] vec3.fs [if]

vocabulary vec3.fs also vec3.fs definitions

require fp.fs

also fp.fs

0 \ vector3
dup constant v.x 1 cells +
dup constant v.y 1 cells +
dup constant v.z 1 cells +
constant vector3

: v.x@ v.x + @ ;
: v.y@ v.y + @ ;
: v.z@ v.z + @ ;

create v0 vector3 allot
create v1 vector3 allot
create v2 vector3 allot

: v! ( x y z addr -- ) dup >r v.z + ! r@ v.y + ! r> ! ;
: v@ ( v -- x y z )    dup @ swap dup v.y@ swap v.z@ ;

: vadd ( v0 v1 -- v2 )
  v1 v! v0 v!

  v0 v.x@ v1 v.x@ +
  v0 v.y@ v1 v.y@ +
  v0 v.z@ v1 v.z@ +
;

: vsub ( v0 v1 -- v2 )
  v1 v! v0 v!

  v0 v.x@ v1 v.x@ -
  v0 v.y@ v1 v.y@ -
  v0 v.z@ v1 v.z@ -
;

: vmul ( v0 v1 -- v2 )
  v1 v! v0 v!

  v0 v.x@ v1 v.x@ fp*
  v0 v.y@ v1 v.y@ fp*
  v0 v.z@ v1 v.z@ fp*
;

: vdiv ( v0 v1 -- v2 )
  v1 v! v0 v!

  v0 v.x@ v1 v.x@ fp/
  v0 v.y@ v1 v.y@ fp/
  v0 v.z@ v1 v.z@ fp/
;

\ https://www.fpgarelated.com/showarticle/1347.php
\ TODO: cheat with FPU, fix this!
: vlength ( v0 -- n )
  v0 v!

  v0 v.x@ fp>f fdup f*
  v0 v.y@ fp>f fdup f* 
  v0 v.z@ fp>f fdup f* f+ f+ fsqrt f>fp

  \ v0 v.x@ dup fp*
  \ v0 v.y@ dup fp*
  \ v0 v.z@ dup fp* + +
;

: vdot ( v0 v1 -- n )
  v1 v! v0 v!

  v0 v.x@ v1 v.x@ fp*
  v0 v.y@ v1 v.y@ fp*
  v0 v.z@ v1 v.z@ fp*

  + +
;

: vcross ( v0 v1 -- v2 )
  v1 v! v0 v!

  v0 v.y@ v1 v.z@ fp*
  v0 v.z@ v1 v.y@ fp* -

  v0 v.z@ v1 v.x@ fp*
  v0 v.x@ v1 v.z@ fp* -

  v0 v.x@ v1 v.y@ fp*
  v0 v.y@ v1 v.x@ fp* -
;

: vnormal ( v0 v1 v2 -- v3 )
  v2 v! v1 v! v0 v!

  v1 v@ v0 v@ vsub
  v2 v@ v0 v@ vsub
  vcross
;

: vnormalize ( v0 -- v1 )
  v0 v!
  v0 v@
  v0 v@ vlength dup dup
  vdiv
;

\ 1 i>fp 2 i>fp 3 i>fp
\ 1 i>fp 5 i>fp 7 i>fp vdot fp>i .s

\ \ 1 i>fp 2 i>fp 3 i>fp .s vnormalize .s
\ bye

\ 0e 16384e f/
\ 0e 16384e f/
\ -16384e 16384e f/

\ 54e 16384e f/
\ 4879e 16384e f/
\ -16384e 16384e f/

\ f.s
\ bye

previous definitions

[then]