wip
This commit is contained in:
@@ -68,8 +68,8 @@ open forward
|
||||
S4=scl*sin(AA4*$camSf)
|
||||
S5=scl*sin(AA5*$camSf)
|
||||
|
||||
send 1"fwd_inp(%f) %f %f %f %f %f\\n",D0,AA1,AA2,AA3,AA4,AA5
|
||||
send 1"fwd_inp(%f) %f %f %f %f %f\\n",D0,S1,S2,S3,S4,S5
|
||||
//send 1"fwd_inp(%f) %f %f %f %f %f\\n",D0,AA1,AA2,AA3,AA4,AA5
|
||||
//send 1"fwd_inp(%f) %f %f %f %f %f\\n",D0,S1,S2,S3,S4,S5
|
||||
|
||||
|
||||
//X=D^-1*S
|
||||
@@ -79,7 +79,7 @@ open forward
|
||||
V=-1.*S1 +1.*S2 +1.5*S3 -.5*S4 -.5*$sqrt2*S5
|
||||
W=-1.*S1 -1.*S2 +.5*S3 +.5*S4 +.5*$sqrt2*S5
|
||||
|
||||
send 1"fwd_res %f %f %f %f %f\\n",X,Y,U,V,W
|
||||
//send 1"fwd_res %f %f %f %f %f\\n",X,Y,U,V,W
|
||||
|
||||
D0=$$000000f8; //U=$$8 V=$$10 W=$$20 X=$$40 Y=$$80 hex(8+int('10',16)+int('20',16)+int('40',16)+int('80',16)) -> '0xf8'
|
||||
close
|
||||
@@ -93,7 +93,7 @@ open inverse
|
||||
//if(D0>0)
|
||||
// send 1"Velocity calculation NOT SUPPORTED\\n"
|
||||
|
||||
send 1"inv_inp(%f) %f %f %f %f %f\\n",D0,X,Y,U,V,W
|
||||
//send 1"inv_inp(%f) %f %f %f %f %f\\n",D0,X,Y,U,V,W
|
||||
|
||||
r=$height/$width
|
||||
|
||||
@@ -110,7 +110,7 @@ open inverse
|
||||
AA4=asin(S4*scl)/$camSf
|
||||
AA5=asin(S5*scl)/$camSf
|
||||
|
||||
send 1"inv_res %f %f %f %f %f\\n",AA1,AA2,AA3,AA4,AA5
|
||||
//send 1"inv_res %f %f %f %f %f\\n",AA1,AA2,AA3,AA4,AA5
|
||||
|
||||
close
|
||||
|
||||
|
||||
Reference in New Issue
Block a user