これは足をうごめかす何かです。
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); } }