y w / Mbed 2 deprecated moter_titech

Dependencies:   mbed-rtos mbed

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers DOU.h Source File

DOU.h

00001  
00002  void DOU1(void const *argument) {
00003  Dou1.period(0.0001);
00004   Dou1.pulsewidth(0.00005f);
00005  while(true){
00006      if(dou1==1){
00007         switch(deg1){
00008             case 1:
00009             Dou1.pulsewidth(0.00010f); //iki
00010             if(pote1>0.7f)deg1=2;
00011             break;
00012             
00013             case 2:
00014             Dou1.pulsewidth(0.00005f); //stop
00015             deg1=3;
00016             break;
00017             
00018             case 3:
00019             Dou1.pulsewidth(0.00000f); //kaeri
00020             if(pote1<0.3f)deg1=4;
00021             break;
00022             
00023             case 4:
00024             Dou1.pulsewidth(0.00005f); //stop
00025             deg1=1;
00026             dou1=0;
00027             break;
00028         }
00029     }
00030     }
00031 }
00032 
00033  
00034   void DOU2(void const *argument) {
00035  Dou2.period(0.0001);
00036   Dou2.pulsewidth(0.00005f);
00037  while(true){
00038      if(dou2==1){
00039         switch(deg2){
00040             case 1:
00041             Dou2.pulsewidth(0.00010f); //iki
00042             if(pote2>0.566f)deg2=2;
00043             break;
00044             
00045             case 2:
00046             Dou2.pulsewidth(0.00005f); //stop
00047             deg2=3;
00048             break;
00049             
00050             case 3:
00051             Dou2.pulsewidth(0.00000f); //kaeri
00052             if(pote2<0.53f)deg2=4;
00053             break;
00054             
00055             case 4:
00056             Dou2.pulsewidth(0.00005f); //stop
00057             deg2=1;
00058             dou2=0;
00059             break;
00060         }
00061     }
00062     }
00063 }
00064 
00065 
00066