示例#1
0
void
vexSonarDebug(vexStream *chp, int argc, char *argv[])
{
    (void)argc;
    (void)argv;

    tVexSonarChannel    c;

    for(c=kVexSonar_1;c<kVexSonar_Num;c++)
        {
        vex_chprintf(chp,"S%d %d %5d %5d ", c, vexSonars[c].flags, vexSonars[c].time_r, vexSonars[c].time_f );
        vex_chprintf(chp,"%5d %4d(cm) %3d(inch)\r\n", vexSonars[c].time, vexSonars[c].distance_cm, vexSonars[c].distance_inch );
        }
}
示例#2
0
void
vexBkupDebug(vexStream *chp, int argc, char *argv[])
{
    int i;

    (void)argc;
    (void)argv;

    vex_chprintf( chp, "Backup Registers\r\n" );
    vex_chprintf( chp, "00-15: " );
    for(i=0; i<16; i++)
        vex_chprintf( chp, "%02X ", vexBkupRegisterRead(i) );
    vex_chprintf(chp,"\r\n");
    vex_chprintf( chp, "16-32: " );
    for(i=16; i<32; i++)
        vex_chprintf( chp, "%02X ", vexBkupRegisterRead(i) );
    vex_chprintf(chp,"\r\n");
    vex_chprintf( chp, "32-41: " );
    for(i=32; i<42; i++)
        vex_chprintf( chp, "%02X ", vexBkupRegisterRead(i) );
    vex_chprintf(chp,"\r\n");
}
示例#3
0
void
vexLcdDebug(vexStream *chp, int argc, char *argv[])
{
    (void)argc;
    (void)argv;

    if( vexLcdData[0].enabled){
        vex_chprintf(chp,"\r\n" );
        vex_chprintf(chp,"LCD 0 \r\n" );
        vex_chprintf(chp,"%-16s\r\n", vexLcdData[0].line1 );
        vex_chprintf(chp,"%-16s\r\n", vexLcdData[0].line2 );
        vex_chprintf(chp,"Buttons = %2X\r\n", vexLcdData[0].buttons );
        }

    if( vexLcdData[1].enabled){
        vex_chprintf(chp,"\r\n" );
        vex_chprintf(chp,"LCD 1 \r\n" );
        vex_chprintf(chp,"%-16s\r\n", vexLcdData[1].line1 );
        vex_chprintf(chp,"%-16s\r\n", vexLcdData[1].line2 );
        vex_chprintf(chp,"Buttons = %2X\r\n", vexLcdData[1].buttons );
        }
}