Skip to main content

move_to_goal

Function move_to_goal 

Source
pub fn move_to_goal(
    arm: &mut NLinkArm,
    goal_angles: &[f64],
    goal_pos: &[f64; 2],
    goal_threshold: f64,
) -> Vec<Vec<f64>>
Expand description

Runs the proportional-control IK loop: smoothly moves from current angles toward goal angles.

Returns the trajectory of joint angle snapshots.