これは足をうごめかす何かです。

Dependencies:   mbed

main.cpp

Committer:
shiyuu
Date:
2014-09-16
Revision:
0:6ca09b29723e

File content as of revision 0:6ca09b29723e:

/*send  すいっちの簡単版*/
#include "mbed.h"
AnalogIn aa(p19);
AnalogIn bb(p17);
//DigitalIn sw4[4]={p12,p13,p14,p15};
DigitalIn switch_on(p15);
//DigitalIn switch_rt(p14);
//DigitalIn switch_lu(p13);
//DigitalIn switch_lt(p12);
Serial pc(USBTX,USBRX);
Serial Xbee (p28,p27);//p9, p10
void SetUp(void);

void Setup(void){
    /*
    sw4[0].mode(PullUp);
    sw4[1].mode(PullUp);
    sw4[2].mode(PullUp);
    sw4[3].mode(PullUp);
    */
    
    switch_on.mode(PullUp);
    //switch_rt.mode(PullUp);
    //switch_lu.mode(PullUp);
    //switch_lt.mode(PullUp);
    
    uint8_t i=1;
 
    Xbee.putc(i);
    }
    
int main() {
    
    unsigned int c1,c2;
    int data,rd,ld,swon;    
    
    count=1;

    Setup();

    c1=aa.read_u16();  //中央値
    c2=bb.read_u16();  //  
    
    while(1) {
        rd=ld=0;
        swon=0;
        
        /*   LEFT   */
        
        if(bb.read_u16()>(c2*1.2)){
                ld=0x80;//10000000       128  
            
        }else if((bb.read_u16() >= 0 )&&(bb.read_u16()<(c2 * 0.7))){
           
                ld=0x40;//01000000       64 
                
        }
    
        /*  RIGHT   */
        
        if(aa.read_u16()>(c1*1.2)){
                rd=0x20;//00100000   32   
                
        }else if((aa.read_u16() >= 0 )&&(aa.read_u16()<(c1 * 0.7))){

                rd=0x10;//00010000     16 
    
        }
 
            swon=!switch_on;
            
        /*    
        swlu=!sw4[0];
        swlt=!sw4[1];
        swrt=!sw4[2];
        swru=!sw4[3];
         */
         
        data=rd+ld+swon;        //
        
        //pc.printf("%d\n",swon);
        pc.printf("%d\n",data);
        
        //pc.printf("%d  %d  %d  %d\n",lt,lu,rt,ru);
        //pc.printf("%d\n",swrt);
        
        Xbee.putc(data);
        
    }
}