Implement AXIS parity UI and execution baseline
This commit is contained in:
@@ -20,6 +20,15 @@ int main(void) {
|
||||
input.x = 0.0; input.y = 0.0; input.z = 0.0;
|
||||
assert(sim_posemath_normalize(&input, &output) == SIM_POSEMATH_ERR_DEGENERATE);
|
||||
|
||||
{
|
||||
sim_posemath_pose start = {{1.0, 0.0, 0.0}, 0, 0, 0, 0, 0, 0};
|
||||
sim_posemath_pose finish = {{0.0, 1.0, 0.0}, 0, 0, 0, 0, 0, 0};
|
||||
sim_posemath_segment arc = {start, finish, {0, 0, 0}, {0, 0, 1}, 1.0, 2.0, SIM_POSEMATH_CIRCULAR, 1};
|
||||
assert(sim_posemath_segment_validate(&arc) == SIM_POSEMATH_OK);
|
||||
assert(sim_posemath_segment_point(&arc, 0.5, &output) == SIM_POSEMATH_OK);
|
||||
assert(fabs(output.tran.x * output.tran.x + output.tran.y * output.tran.y - 1.0) < 1e-9);
|
||||
}
|
||||
|
||||
{
|
||||
sim_posemath_pose start = {{0.0, 0.0, 0.0}, 0, 0, 0, 0, 0, 0};
|
||||
sim_posemath_pose finish = {{2.0, 0.0, 0.0}, 1, 2, 3, 4, 5, 6};
|
||||
|
||||
Reference in New Issue
Block a user