Create variables in function of kinematics values

More
24 Sep 2015 07:02 - 25 Sep 2015 03:18 #62921 by jstoquica
Sorry, I had to restore the permissions.
Last edit: 25 Sep 2015 03:18 by jstoquica.

Please Log in or Create an account to join the conversation.

More
24 Sep 2015 07:19 #62925 by andypugh
It is possible that inverse kins doesn't run in joint mode (just a guess, I don't know for sure).

As a test, set the pins to 1, 2, 3, 4, 5 (for example) just before the function exit point.

Please Log in or Create an account to join the conversation.

More
24 Sep 2015 07:27 #62926 by jstoquica
like this ?
   /* Joint 5 */

   s5 = c1 * hom.rot.x.x + s1 * hom.rot.x.y;
   c5 = c1 * hom.rot.y.x + s1 * hom.rot.y.y;


   th5 = atan2(s5, c5);

   /* copy out */

   *(haldata->th1) = 2;//th1*180/PM_PI;
   *(haldata->th2) = 4;//th2*180/PM_PI;
   *(haldata->th3) = 6;//th3*180/PM_PI;
   *(haldata->th4) = 8;//th4*180/PM_PI;
   *(haldata->th5) = 10;//th5*180/PM_PI;


   joint[0] = *(haldata->th1);
   joint[1] = *(haldata->th2);
   joint[2] = *(haldata->th3);
   joint[3] = *(haldata->th4);
   joint[4] = *(haldata->th5);

   return 0;
}

Please Log in or Create an account to join the conversation.

More
24 Sep 2015 07:34 #62928 by jstoquica
I tested but the th? values are 0 yet.

Please Log in or Create an account to join the conversation.

More
24 Sep 2015 17:17 #62940 by andypugh
Making the change where you have will mess up the joint[] value outputs to axis.N.motor-position-cmd,

To check if the problem is that reverse kinematics doesn't run in joint mode, switch to world mode.

Please Log in or Create an account to join the conversation.

More
25 Sep 2015 03:28 #62955 by jstoquica
Hi,

In fact, when is in "world mode" the thx values are the same that kinematics modified file. But the vismach model doesn't move.

Please Log in or Create an account to join the conversation.

More
25 Sep 2015 03:31 #62956 by andypugh

In fact, when is in "world mode" the thx values are the same that kinematics modified file. But the vismach model doesn't move.


The model wouldn't move if the values are fixed to 1,2,3 etc.

What happens in world mode with the previous kinematics file?

Please Log in or Create an account to join the conversation.

More
25 Sep 2015 04:39 #62958 by jstoquica
Hi,

After do that, the vismach model moved, but when run some G program the end-effector trajectory has X axis offset. Like can you see in the next image:

Attachments:

Please Log in or Create an account to join the conversation.

More
25 Sep 2015 05:11 #62959 by andypugh
How fascinating. Do let me know what the problem turns out to be :-)

Please Log in or Create an account to join the conversation.

More
25 Sep 2015 06:49 - 25 Sep 2015 06:56 #62962 by jstoquica
Hi,

Yeah it's strange. However, I did the next:

1. Home all joints in "Joint Mode"
2. Switch to "World Mode"
3. Touch off all axis.
4. Run the program.

When I did that, the end-effector trajectory was success like you can see at image:



I have two questions:

1. I think isn't necessary, but, Is it possible works with the simulation and real operation in "Joint Mode"?
2. I still have not tried, but, are the position-cmd and position-fb loopback independents when I will simulate and control the motors, i.e., Can I control the virtual and real motors with them without any performance issue?

Thanks a lot for your time and knowledge.
Attachments:
Last edit: 25 Sep 2015 06:56 by jstoquica.

Please Log in or Create an account to join the conversation.

Time to create page: 0.105 seconds
Powered by Kunena Forum