Skip to main content

Lectura del estado del interpolador

Vea el CNC13_ReadInterpolatorState.project proyecto de ejemplo en el directorio de instalación de CODESYS debajo ..\CODESYS SoftMotion\Examples.

El proyecto de ejemplo muestra cómo leer el estado del interpolador CNC. El estado se usa para mostrar la posición de la máquina en las coordenadas de la máquina y del decodificador

Estructura de la solicitud

La estructura es típica de las aplicaciones de CNC. El código G se lee en la tarea en segundo plano. La interpolación se realiza en la tarea del bus

Durante la interpolación, el SMC_ReadAdditionalIpoState bloque de función llamado.

Tan pronto como comience la interpolación, el Valid la salida es TRUE. La posición del interpolador, que siempre aparece en el sistema de coordenadas de la máquina (MCS), se convierte a continuación utilizando el sistema de coordenadas del decodificador (DCS) actual y

SMC_V3_Set(pos_MCS, ipo.piSetPosition.dX, ipo.piSetPosition.dY, ipo.piSetPosition.dZ);

readState(
    Enable:= TRUE,
    ipo:= ipo);

IF readState.Valid THEN
    SMC_PosInfo_Trf_Inverse(
        piOut:= piMCS_to_DCS,
        piIn:= readState.State.DCS,
        eOriConv:= readState.State.OriConv);

     SMC_PosInfo_Trf_Apply(
        vDst:= pos_DCS,
        piTrf:= piMCS_to_DCS,
        vSrc:= pos_MCS,
        eOriConv:= readState.State.OriConv);
END_IF

Para obtener más información sobre el sistema de coordenadas del decodificador, consulte lo siguiente: Cambiar, rotar y escalar el sistema de coordenadas.

Puesta en servicio

  1. Cree la aplicación y descárguela en un controlador.

  2. Abra la visualización.

  3. Inicie la aplicación y pulse el Comenzar botón de la visualización.

    Puede rastrear el movimiento de las coordenadas X e Y en MCS y DCS.