Location via proxy:   [ UP ]  
[Report a bug]   [Manage cookies]                
Scribd Logo
Upload

Welcome to Scribd!

  • 156 views

    Crank Arm Kinematics

    Uploaded by

    Noor Nabi Mujahid
    The document describes the forward and inverse kinematics algorithms used to relate the linear position of an end effector to the rotary position of a crank in a crank-arm mechanism. The forward kinematics algorithm calculates the linear position from the rotary position using trigonometry. The inverse kinematics algorithm calculates the rotary position that produces the minimum acceleration by selecting the solution to the inverse trigonometric function that results in the lower acceleration value. The algorithms are implemented in program buffers that are automatically executed to perform the kinematic transformations.

    Copyright:

    Attribution Non-Commercial (BY-NC)
    Download as PDF, TXT or read online from Scribd

    Crank Arm Kinematics

    Uploaded by

    Noor Nabi Mujahid
    156 views3 pages
    The document describes the forward and inverse kinematics algorithms used to relate the linear position of an end effector to the rotary position of a crank in a crank-arm mechanism. The forward kinematics algorithm calculates the linear position from the rotary position using trigonometry. The inverse kinematics algorithm calculates the rotary position that produces the minimum acceleration by selecting the solution to the inverse trigonometric function that results in the lower acceleration value. The algorithms are implemented in program buffers that are automatically executed to perform the kinematic transformations.

    Original Description:

    Inverse and Forward Kinematics for Crank Arm are derived

    Copyright

    © Attribution Non-Commercial (BY-NC)

    Available Formats

    PDF, TXT or read online from Scribd

    Did you find this document useful?

    Is this content inappropriate?

    The document describes the forward and inverse kinematics algorithms used to relate the linear position of an end effector to the rotary position of a crank in a crank-arm mechanism. The forward kinematics algorithm calculates the linear position from the rotary position using trigonometry. The inverse kinematics algorithm calculates the rotary position that produces the minimum acceleration by selecting the solution to the inverse trigonometric function that results in the lower acceleration value. The algorithms are implemented in program buffers that are automatically executed to perform the kinematic transformations.

    Copyright:

    Attribution Non-Commercial (BY-NC)
    Download as PDF, TXT or read online from Scribd
    Download as pdf or txt
    156 views3 pages

    Crank Arm Kinematics

    Uploaded by

    Noor Nabi Mujahid
    The document describes the forward and inverse kinematics algorithms used to relate the linear position of an end effector to the rotary position of a crank in a crank-arm mechanism. The forward kinematics algorithm calculates the linear position from the rotary position using trigonometry. The inverse kinematics algorithm calculates the rotary position that produces the minimum acceleration by selecting the solution to the inverse trigonometric function that results in the lower acceleration value. The algorithms are implemented in program buffers that are automatically executed to perform the kinematic transformations.

    Copyright:

    Attribution Non-Commercial (BY-NC)
    Download as PDF, TXT or read online from Scribd
    Download as pdf or txt
    of 3

    Application Note

    Nov-2004

    Crank-Arm Kinematics
    Crank-arm mechanisms are used in many devices to convert rotary motion into reciprocating linear motion. Presses involving crank arms are starting to use servo motors to provide greater flexibility in the press cycles they provide. Many users would like to program these devices directly in terms of the linear dimension, not of the underlying rotary crank angle. Turbo PMACs kinematic algorithms permit this method of programming by automatically computing the transformation between the linear end-effector position and the rotary crank angle. The geometry in this mechanism is quite simple. The trickiest aspect of the kinematics algorithms is to decide which of the two possible crank angles should be used for a given end-effector position. There are many possible methods for making this decision; in this example we make the choice that minimizes crank-wheel acceleration.

    Mechanism Description
    The mechanism has an arm of length L attached by a pivoting joint at one end to an end-effector that is constrained to move in only one direction with the line between this pivot and the center of the crank collinear with the motion of the end-effector. At the other end of the arm is a pivot joint connecting the arm to the rotating crank wheel at a distance R from the center of the crank wheel. The crank wheel is driven by a servo motor.

    R X

    Forward Kinematics
    In the forward kinematics, we want to compute the linear X position from the rotary position. We start with the law of cosines for the triangle with sides of lengths R, L and X:
    L2 = X 2 + R 2 2 RX cos

    We convert this to a quadratic equation in X, and solve:


    X 2 2 R cos X + R 2 L2 = 0

    X = R cos R 2 cos 2 R 2 + L2

    Due to the physical constraints the arm can only go out to the right in our drawing only the positive solution is valid. The following setup and program can be used to implement the forward kinematics: Macro Substitution Definitions Status/control bits using suggested M-variable definitions
    #define Mtr1Homed M145 Mtr1Homed->Y:$0000C0,10,1 #define CS1RunTimeErr M5182 CS1RunTimeErr->Y:$00203F,22,1 ; ; ; ; Motor 1 home complete bit Bit 10 in Motor 1 status word CS 1 run-time error bit Bit 22 in C.S. 1 status word

    Crank Arm Kinematics Example

    Nov-2004

    Application Note

    Definitions to Variables with Fixed Functions


    #define Mtr1KinPos P1 #define XkinPos Q7 #define #define #define #define #define #define #define I15=0 I5150=1 Mtr1Scale=200 Rad=400 Len=750 L2MinR2=Len*Len-Rad*Rad Mtr1Scale Q120 Rad Q121 Len Q122 L2MinR2 Q123 Theta Q124 CosTheta Q125 Dtheta Q126 ; #1 pos in cts for kinematics ; X-axis pos in deg for kin ; ; ; ; ; ; ; Counts per degree of crank Radius of crank Length of crank arm Len^2 Rad^2 Intermediate angle term Intermediate trig term Velocity term

    Definitions to Variables with Open Functions

    Setup for Program


    ; Trig calcs in degrees ; Enable kinematics for C.S.1 ; ; ; ; Counts per degree mm mm Pre-compute for efficiency

    Compute System Constants (these may go in power-on PLC)

    Forward Kinematic Program Buffer for Repeated Execution


    &1 OPEN FORWARD CLEAR IF(Mtr1Homed=1) ; Valid position reference? Theta=(Mtr1KinPos/Mtr1Scale)%-180 CosTheta=COS(Theta) ; Compute once for efficiency XKinPos=Rad*CosTheta+SQRT(Rad*Rad*CosTheta*CosTheta-L2MinR2) DTheta=0 ; Starts at zero velocity ENDIF CLOSE

    This forward-kinematics program will be executed automatically every time Coordinate System 1 starts a motion program. It can also be executed on a PMATCH command. Note that variables Theta and DTheta are computed and stored for use by the inverse kinematic program.

    Inverse Kinematics
    In the inverse kinematics, we want to compute the rotary position from the linear X position. We rearrange the law-of-cosine equation used in the forward kinematics to isolate and solve for :
    2 RX cos = X 2 + R 2 L2

    cos =

    X 2 + R 2 L2 2 RX X 2 + R 2 L2 2 RX

    = cos 1

    Here, both the positive and negative arc-cosine solutions are potentially valid, and we must devise a method to choose between them. In this example, we will choose the solution that produces the lowest acceleration in . When we are not close to 0 or 180 degrees, this strategy will keep us on the same side (as would choosing the lowest velocity). As we pass through 0 or 180 degrees, this will keep us moving in the same direction (using the lowest velocity would not necessarily do this). Because the crank wheel can rotate many revolutions, we cannot simply use the arc-cosine solution. Instead, we must extend this value by computing the change in angle, and adding this to an accumulated multi-turn angle.

    Crank Arm Kinematics Example

    Application Note

    Nov-2004

    Additional Definitions for Inverse Kinematic Program


    #define #define #define #define #define #define &1 #1->I ThetaP Q131 ThetaM Q132 DthetaP Q133 DthetaM Q134 D2ThetaP Q135 D2ThetaM Q136 ; ; ; ; ; ; Possible Possible Velocity Velocity Accel if Accel if positive soln negative soln if positive soln if negative soln positive soln negative soln

    Additional Setup for Inverse Kinematic Program


    ; Motor 1 assigned to inverse kinematic axis ; in CS 1 ; Solve inv. kin. every 10 msec

    I5113=10 &1 OPEN INVERSE CLEAR CosTheta=(XKinPos*XKinPos-L2MinR2)/(2*Rad*XKinPos) IF(CosTheta!>1.0 AND CosTheta!<-1.0) ; Valid position? ThetaP=ACOS(CosTheta) ; Tentative positive soln ThetaM=-ThetaP ; Tentative negative soln DThetaP=(ThetaP-Theta)%-180 ; Velocity for positive soln DThetaM=(ThetaM-Theta)%-180 ; Velocity for negative soln D2ThetaP=DThetaP-DTheta ; Accel for positive soln D2ThetaM=DThetaM-DTheta ; Accel for negative soln IF(ABS(D2ThetaP)<ABS(D2ThetaM)) ; Use positive soln Theta=ThetaP ; Select and save for next cycle DTheta=DThetaP ; Select and save for next cycle ELSE ; Use negative soln Theta=ThetaM ; Select and save for next cycle DTheta=DThetaM ; Select and save for next cycle ENDIF Mtr1KinPos=Mtr1KinPos+DTheta*Mtr1Scale ; Accumulated angle ELSE ; Command out of range CS1RunTimeErr=1 ; Set to stop ENDIF CLOSE

    Note that by selecting the positive solution only if its resulting acceleration is less than the acceleration for the negative solution, when we start from a stop at 0o or 180o, we will choose the negative solution. If we had used the !> (not greater than) comparator instead of the < (less than) comparator, we would have chosen the positive solutions in these cases instead.

    Crank Arm Kinematics Example

    You might also like