Generate Pose from Sphere Fitting Result
Function: Generate the pose of the current three balls from three relatively fixed pose balls
Input Parameters:
| Name | Type | Valid Range | Default Value | Meaning |
|---|---|---|---|---|
Ball parameters |
List |
None |
None |
list of n * 4, including center and radius [center.x center.y center.z radius] |
Output Parameters:
| Name | Type | Valid Range | Default Value | Meaning |
|---|---|---|---|---|
Current size |
Float |
None |
None |
Current size |
Current position Matrix |
Matrix |
None |
None |
4*4 matrix, including pose rotation and translation |