test

Dependencies:   mbed

Dependents:   MouseHybridSenseCode

main.cpp

Committer:
JamieBignell
Date:
2018-03-05
Revision:
3:7f44ab64e96b
Parent:
0:c0c329729a7a
Child:
4:f1670eec4681

File content as of revision 3:7f44ab64e96b:

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

int main() 
{
    //runs code once
    while (1)
    {     
        static bool initialized=false;
        if (!initialized) 
        {
            initialized = true;
            leftMotorVal.period_ms(10);
            for (int i=1; i <=5; i++)
            {
                LEDVal =1;
                wait(0.5);
                LEDVal =0;
                wait(0.5);
            }
            leftMotorVal.period_us(1023);
            rightMotorVal.period_us(1023);                     
            /*
            for (int i=0;i<=7;i++)
            {
                sensorValue[i]=((sensorPin[i]).read_u16()>>4);
                sensorMinValue[i]=sensorValue[i];
                sensorMaxValue[i]=sensorValue[i];
            } 
            */
                   
        }    
        /* 
        int doneYet=0;  
        while(1)
        {    
            for (int i=0;i<=7;i++)
            {
                sensorValue[i]=((sensorPin[i]).read_u16()>>4);
                if (sensorValue[i]>=sensorMaxValue[i])
                {      
                    sensorMaxValue[i]=sensorValue[i];      
                }
                else if ((sensorValue[i]+25)<=sensorMaxValue[i]) 
                {
                    doneYet++;
                    if (doneYet==8)
                    {
                        break;
                    }
                }
                wait_ms(5);
            }    
        }
        */
        for (int i=0;i<=7;i++)
        {
            sensorValue[i]=((sensorPin[i]).read_u16()>>4);            
        } 
        CalibrateFunc();          
        //set baud rate 9600
        pc.printf("$%d %d %d ;", (sensorValue[0]),(sensorValue[1]),(sensorValue[2]));
        wait_ms(10);
    }   
                
    //printf("ADC Val 1 : %d\r\n",();
    return 0;
}