Sign in to follow this  
manu1001

help with CCD algorithm

Recommended Posts

i'm trying to achieve inverse kinematics using cyclic-coordinate descent (CCD) for a chain of joints - (0, 1, 2, ... , s). from what i've understood of it, i've written some code which does not work at all. could you please tell where i'm going wrong. i've modified the code to make it understandable.
//                  * d (x,y)
//                 
//                
//  *-----*------*-------*
//        <---(i) q    (s) p

Coord p, q, d;
Joint *ptrp, *ptrq, *ptrj;
double m1, m2, t;

// 's + 1' number of joints in chain

d = target_coord();

ptrp = getjoint(s);
for (i = s - 1; i > 0; i--){

	p = ptrp->getcoord();
	
        ptrq = getjoint(i);
	q = ptrq->getcoord();

        // calculate angle 't' between pq and dq using slopes
	m1 = (p.y - q.y) / (double) (p.x - q.x);
	m2 = (d.y - q.y) / (double) (d.x - q.x);
	t = (m1 * m2 != -1.0)? atan((m2 - m1) / (1 + m1 * m2)) : PI / 2;

	for (j = i + 1; j <= s; j++){     // for all children
		ptrj = getjoint(j);
		ptrj->add_rotangle(t);
	}
}



the above loop will be run several times inside another loop.

Share this post


Link to post
Share on other sites

Create an account or sign in to comment

You need to be a member in order to leave a comment

Create an account

Sign up for a new account in our community. It's easy!

Register a new account

Sign in

Already have an account? Sign in here.

Sign In Now

Sign in to follow this