disp_test.C

Ir a la documentación de este archivo.

//===========================================================================
//= disptest.cc                                            Febrero del 2000 =
//=-------------------------------------------------------------------------=
//= Definiciones de la clase para el control de la interface                =
//= DISPOSITIVO_DE_PRUEBA                                                   =
//=-------------------------------------------------------------------------=
//= ADVERTENCIA: ESTE SOFTWARE NO ESTA CONCEBIDO NI DISENNADO PARA EL USO   =
//= EN EQUIPO DE CONTROL EN LINEA EN ENTORNOS PELIGROSOS QUE REQUIERAN UN   =
//= DESEMPENNO LIBRE DE FALLAS, COMO LA OPERACION DE PLANTAS NUCLEARES,     = 
//= SISTEMAS DE NAVEGACION O COMUNICACION EN AVIONES, TRAFICO AEREO,        =
//= EQUIPO MEDICO DEL CUAL DEPENDAN VIDAS HUMANAS O SISTEMAS DE ARMAMENTO,  =
//= EN LOS CUALES UNA FALLA EN EL SOFTWARE PUEDA IMPLICAR DIRECTAMENTE LA   =
//= MUERTE, DANNOS PERSONALES O DANNOS FISICOS Y/O AMBIENTALES GRAVES       =
//= ("ACTIVIDADES DE ALGO RIESGO").                                         =
//=-------------------------------------------------------------------------=
//= Autor original: Oscar J. Chavarro G.  A.K.A. JEDILINK. Copyright (c),   =
//= 1997 - 2003, oscarchavarro@hotmail.com                                  =
//= AQUYNZA es software libre, y se rige bajo los terminos de la licencia   =
//= LGPL de GNU (http://www.gnu.org). Para mayor informacion respecto a la  =
//= licencia de uso, consulte el archivo ./doc/LICENCIA en la distribucion. =
//= Con la colaboracion de Harold Cruz              ha-cruz@uniandes.edu.co =
//===========================================================================

#if PLATAFORMA == i386_LINUX_GCC || PLATAFORMA == ALPHA  // OJO: Esto es machete! || PLATAFORMA == SPARC64_LINUX_GCC

#include "toolkits/media/disp_test.h"

#include <string.h>

//===========================================================================
//= Funciones de soporte                                                    =
//===========================================================================

void
leer_disptest_callback(void * /*User_data*/, int /*accion*/)
{
/*
    DISPOSITIVO_DE_PRUEBA *L = ((DISPOSITIVO_DE_PRUEBA*)User_data);
    PUERTO_SERIAL *Com = L->Com;
    char buffer[19];  // La interface enviara maximo 19 bytes
    int bytes_leidos;
    int p;
*/
//    bytes_leidos = Com->leer(buffer, 19);

    fprintf(stderr, "<DISPOSITIVO DE PRUEBA> WARNING - Se supone que no!\n");
    fflush(stderr);

/*
    for ( p = 0; p < bytes_leidos; p++ ) {
    }
*/
}

//===========================================================================
// Clase DISPOSITIVO_DE_PRUEBA                                                           =
//===========================================================================

DISPOSITIVO_DE_PRUEBA::DISPOSITIVO_DE_PRUEBA()
{
    printf("Me dispongo a usar el dispositivo de prueba...\n");
    fflush(stdout);

    int i;

    data_state[0] = 0x33;
    for ( i = 1; i < 4; i++ ) {
        data_state[i] = 0;
    }
}

DISPOSITIVO_DE_PRUEBA::~DISPOSITIVO_DE_PRUEBA()
{
    cerrar();
}

void
DISPOSITIVO_DE_PRUEBA::cerrar(void)
{
    int i;

    data_state[0] = 0x33;
    for ( i = 1; i < 4; i++ ) {
        data_state[i] = 0;
    }
    actualizar();

    if ( Com ) {
        Com->cerrar();
        delete Com;
        Com = 0;
    }
}

BOOLEAN
DISPOSITIVO_DE_PRUEBA::abrir(char *nombre_puerto)
{
    Com = new PUERTO_SERIAL(nombre_puerto);

    if ( !Com ) {
        return FALSE;
    }

    //- Inicializacion del puerto serial -
    Com->configurar(PSV4800, PSP_NONE, PSS_UNO, PSD8, PSF_NONE);
    if ( !Com->abrir() ) {
        delete Com;
        Com = 0;
        return FALSE;
    }
    //Com->imprimir(); // Muestra la configuracion actual del puerto

    Com->registro_asincronico(leer_disptest_callback, this);

    return TRUE;
}

void
DISPOSITIVO_DE_PRUEBA::actualizar(void)
{
    data_state[0] = 0x33;
    Com->escribir(data_state, 4);

    //-----------------------------------------------------------------------
    static int machete = 0;

    machete++;

    if ( machete >= 25 ) { 
        printf("[%d][%d][%d]\n",
            data_state[1], data_state[2], data_state[3]);
        fflush(stdout);
        machete = 0;
    }
}

void
DISPOSITIVO_DE_PRUEBA::motor_a(double v)
{
    double i = fabs(v);

    i = pow (i, 0.5); // Funcion de transferencia (MACHETE!)

    data_state[1] = (char)((int)(floor(i*255)));

    data_state[3] &= 0x7F;
    if ( v > 0 ) data_state[3] |= 0x80;
}

void
DISPOSITIVO_DE_PRUEBA::motor_b(double v)
{
    double i = fabs(v);

    i = pow (i, 0.5); // Funcion de transferencia (MACHETE!)

    data_state[2] = (char)((int)(floor(i*255)));

    data_state[3] &= 0xBF;
    if ( v > 0 ) data_state[3] |= 0x40;
}

void
DISPOSITIVO_DE_PRUEBA::motor_pluma(double v)
{
    double i = fabs(v);
    char p;

    p = (char)((int)(floor(i*63)));
    data_state[3] &= 0xC0;
    data_state[3] |= p & 0x3f;
}

static double TMP_float;

BOOLEAN
DISPOSITIVO_DE_PRUEBA::consultar_variable(const char *nombre_variable, 
                   int &tipo, void **ref)
{
    if ( strcmp(nombre_variable, "motor_a") == 0 ) {
        TMP_float = 0;
        tipo = T_FLOAT; (*ref) = &TMP_float;    return TRUE;
      }
      else if ( strcmp(nombre_variable, "motor_b") == 0 ) {
        TMP_float = 0;
        tipo = T_FLOAT; (*ref) = &TMP_float;    return TRUE;
      }
      else if ( strcmp(nombre_variable, "motor_pluma") == 0 ) {
        TMP_float = 0;
        tipo = T_FLOAT; (*ref) = &TMP_float;    return TRUE;
    }

    return FALSE;
}

BOOLEAN
DISPOSITIVO_DE_PRUEBA::actualizar_variable(const char *nombre_variable, int tipo, void *ref)
{
    if ( strcmp(nombre_variable, "motor_a") == 0 ) {
        if ( tipo != T_FLOAT ) return FALSE;
        TMP_float = *((double *)(ref));
        motor_a(TMP_float);
      }
      else if ( strcmp(nombre_variable, "motor_b") == 0 ) {
        if ( tipo != T_FLOAT ) return FALSE;
        TMP_float = *((double *)(ref));
        motor_b(TMP_float);
      }
      else if ( strcmp(nombre_variable, "motor_palanca") == 0 ) {
        if ( tipo != T_FLOAT ) return FALSE;
        TMP_float = *((double *)(ref));
        motor_pluma(TMP_float);
      }
    ;
    return TRUE;
}

#endif

//===========================================================================
//= EOF                                                                     =
//===========================================================================

---

Este archivo HTML ha sido generado automáticamente a partir del código fuente AQUYNZA. NO LO EDITE. Para mayor información contacte al autor.