Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- from:
- #if (Linkage_1 == Linkage_2)
- SCARA_C2 = ((sq(SCARA_pos[X_AXIS]) + sq(SCARA_pos[Y_AXIS])) / (2 * (float)L1_2)) - 1;
- #else
- SCARA_C2 = (sq(SCARA_pos[X_AXIS]) + sq(SCARA_pos[Y_AXIS]) - (float)L1_2 - (float)L2_2) / 45000;
- #endif
- to:
- #if (Linkage_1 == Linkage_2)
- SCARA_C2 = ( ( sq(SCARA_pos[X_AXIS]) + sq(SCARA_pos[Y_AXIS]) ) / (2 * (float)L1_2) );
- #else
- SCARA_C2 = ( sq(SCARA_pos[X_AXIS]) + sq(SCARA_pos[Y_AXIS]) - (float)L1_2 - (float)L2_2 ) / (2*Linkage_1*Linkage_2);
- #endif
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement