You signed in with another tab or window. Reload to refresh your session.You signed out in another tab or window. Reload to refresh your session.You switched accounts on another tab or window. Reload to refresh your session.Dismiss alert
Dexter.Vector.DCM_to_quaternion() returns [undefined, undefined, undefined, undefined] for a particular input. This bug breaks DH inverse kinematics.It looks like there are a series of if else statements in Dexter.Vector.DCM_to_quaternion() and it is missing a final else statement as a catch all.
I have no idea what the correct math would be for this catch all though. However there are known working methods which are used in current firmware.
The following code reproduces the issue:
//Vector.DCM_to_quaternion() bug:
var DCM
//This case works:
DCM = [
[1, 0, 0],
[0, 1, 0],
[0, 0, 1]
]
out(Vector.DCM_to_quaternion(DCM))
//This case works:
DCM = Vector.make_DCM([30, 45, 60])
out(Vector.DCM_to_quaternion(DCM))
//This case fails
DCM = [
[-0.7195571193772048, 0.6909849857540601, -0.06911802526143601],
[-0.13159082483727083, -0.2334028122649974, -0.9634349910842126],
[-0.6818514550635101, -0.6841512089364833, 0.2588739394734867]
]
out(Vector.DCM_to_quaternion(DCM))
//Roughly 28% of randomized DCMs fail:
var N = 100000
var fail_count = 0
for(let i = 0; i < N; i++){
DCM = Vector.make_DCM([Math.random()*180-180, Math.random()*180-180, Math.random()*180-180])
let quat = Vector.DCM_to_quaternion(DCM)
if(quat[0] === undefined){
fail_count++
}
}
out(Math.round(fail_count / N * 100) + "% out of " + N + " cases fail.")
Dexter.Vector.DCM_to_quaternion() returns [undefined, undefined, undefined, undefined] for a particular input. This bug breaks DH inverse kinematics.It looks like there are a series of if else statements in Dexter.Vector.DCM_to_quaternion() and it is missing a final else statement as a catch all.
I have no idea what the correct math would be for this catch all though. However there are known working methods which are used in current firmware.
The following code reproduces the issue:
dde/math/Vector.js
Line 1388 in 5f84cbb
The text was updated successfully, but these errors were encountered: