test

Dependencies:   mbed

Dependents:   MouseHybridSenseCode

main.cpp

Committer:
JamieBignell
Date:
2018-03-07
Revision:
4:f1670eec4681
Parent:
3:7f44ab64e96b
Child:
5:dfea493f7a12

File content as of revision 4:f1670eec4681:

#include "mbed.h"
#include "funcdef.h"

int main() 
{
    leftMotorVal.period_us(100);
    rightMotorVal.period_us(100);
        
    while(1)
    {
     
        leftMotorVal.write(0.00125*200);
        rightMotorVal.write(0.00125*200);
        wait(3);
        
        leftMotorVal.write(0.00125*200);
        rightMotorVal.write(0.00125*200);
        wait(3);
        
    }
    
    LEDVal=0;
    
    leftMotorVal.write(0.00125*0);
    rightMotorVal.write(0.00125*0);
    
    LEDVal=1;
    CalibrateFunc(); 
    
    LEDVal=0;
    printf("sensorMinValue1    "); 
    for (int i=0;i<=7;i++)
    {
        if (i==7)
        {
            printf("  %d\r\n",sensorMinValue1[i]);
        }
        printf("  %d",sensorMinValue1[i]);                  
    } 
    
    printf("sensorMinValue2    "); 
    for (int i=0;i<=7;i++)
    {
        if (i==7)
        {
            printf("  %d\r\n",sensorMinValue2[i]);
        }
        printf("  %d",sensorMinValue2[i]);                  
    } 
    
    printf("sensorMinValue    ");    
    for (int i=0;i<=7;i++)
    {
        if (i==7)
        {
            printf("  %d\r\n",sensorMinValue[i]);
        }
        printf("  %d",sensorMinValue[i]);                  
    } 
   
    printf("sensorMaxValue1   ");      
    for (int i=0;i<=7;i++)
    {
        if (i==7)
        {
            printf("  %d\r\n",sensorMaxValue1[i]);
        }
        printf("  %d",sensorMaxValue1[i]);                  
    }   
    
    printf("sensorMaxValue2   ");      
    for (int i=0;i<=7;i++)
    {
        if (i==7)
        {
            printf("  %d\r\n",sensorMaxValue2[i]);
        }
        printf("  %d",sensorMaxValue2[i]);                  
    }  
    
    printf("sensorMaxValue   ");      
    for (int i=0;i<=7;i++)
    {
        if (i==7)
        {
            printf("  %d\r\n",sensorMaxValue[i]);
        }
        printf("  %d",sensorMaxValue[i]);                  
    }
    
    printf("sensorThreshold   ");      
    for (int i=0;i<=7;i++)
    {
        if (i==7)
        {
            printf("  %d\r\n",sensorThreshold[i]);
        }
        printf("  %d",sensorThreshold[i]);                  
    }
    
    LEDVal=1;
    return 0;
}