File content as of revision 3:f70ecf1e21d5:

#include "mbed.h"
#include "JPEGCamera.h"
#include "us015.h"
#include "TB6612.h"
DigitalOut myled(LED1);
US015 hs(p12,p11);
DigitalOut thermo(p20);
DigitalOut Ultra(p12);
Serial pc(USBTX,USBRX); // tx, rx
JPEGCamera camera(p9, p10); // TX, RX
TB6612 left(p25,p17,p16);//モーターピン
TB6612 right(p26,p19,p18);//モーターピン
int main(){
  int i=1;
  float th;
  Timer tm;
  for(i=0;i<3;i++){
  pc.printf("start\r\n");
  left = 100; //左モーター１００％
  right = 100;//右モーター１００％
  bool detected=false;
    thermo=0; //焦電off
    Ultra=1;//超音波on
    
    while(1) {
         printf("超音波on 焦電off" )  ;
         hs.TrigerOut();
         wait(1);
         int distance;
         distance = hs.GetDistance();
         printf("%d\r\n",distance);//距離出力
        
        if(distance<2000){//超音波反応
         left = 0; //左モーター０％
         right = 0;//右モーター０％
         printf("停止\n\r");
         wait(1.5);
         
         Ultra=0;//超音波off
         thermo=1;//焦電on
          printf("超音波off焦電on  ");
          if(true)
             th = thermo;
             if(th=1 && !detected) {//焦電反応ありの場合
               i++; 
               detected=true;
               pc.printf("human\r\n");
               tm.reset();
               tm.start();
          
               LocalFileSystem local("local");
               Timer timer;
               timer.start();
               camera.setPictureSize(JPEGCamera::SIZE320x240);

            
               if (camera.isReady()) {
                 char filename[32];
                 sprintf(filename, "/local/pict%03d.jpg",i);
                 printf("Picture: %s ", filename);
                 if (camera.takePicture(filename)) { 
                  while (camera.isProcessing()) {
                    camera.processPicture();
                    printf("take pictuer!");
                   }
                 }else{
                 printf("take picture failed\r\n");
                 }
               }else{
                 printf("camera is not ready\r\n");
                }
               
               printf("time = %f\n", timer.read());
               
              }else{//焦電反応なしの場合
               detected=false;
               left = 20; //左モーター１０％
               right = 100;//右モーター１００％(右折)
               printf("右折\n\r");
               wait(3.0);
               left = 100; //左モーター１００％
               right = 100;//右モーター１００％
              }           
       }else{//超音波distance>2000
          left = 100; //左モーター100％
          right = 20;//右モーター20％(右折)
         }

    }

}


 
  }