File content as of revision 2:ae058dfdebac:

#include"mbed.h"


BusIn digicode(p5,p6,p7,p8,p9,p10,p11,p12,p13,p14,p15,p16);
DigitalOut s(p17);
Timer t;
Timer t11;

int lireval(){
    int val;
    if(digicode.read()==0){
        val=-3;
        }
    if(digicode.read()==2){
        val=7;
        }
    if(digicode.read()==4){
        val=4;
        }
    if(digicode.read()==8){
        val=1;
        }
    if(digicode.read()==16){
        val=0;
        }
    if(digicode.read()==32){
        val=8;
        }
    if(digicode.read()==64){
        val=5;
        }
    if(digicode.read()==128){
        val=2;
        }
    if(digicode.read()==256){
        val=-2;
        }
    if(digicode.read()==512){
        val=9;
        }
    if(digicode.read()==1024){
        val=6;
        }
    if(digicode.read()==2048){
        val=3;
        }
        return val;
}

void servo()
{
    int c=0;
    t.start();
    t11.start();
    {
        while(c<1)
        {
            if (t11.read()>8)
            {
                t11.reset();
                c++;
            }
            if (t11.read()<4)
            {
                if(t.read()>0.02)
                { t.reset();}
                if (t.read()<0.0193)
                {
                    s.write(1);
                }
                else
                {
                    s.write(0);
                }
            }
            else
            {
                if(t.read()>0.02)
                { t.reset();}
                if (t.read()< 0.0175)
                {
                    s.write(1);
                }
                else
                {
                    s.write(0);
                }
            }
            
                
        }
    }
}