File content as of revision 10:03d5aa2511c4:

#include "mbed.h"
#include "controller.h"
#include "servo_api.h"
#include "camera_api.h"
#include "motor_api.h"
#include "pot.h"


#define Debug_cam_uart
#define R_eye
#define motor_on 
#define Pcontroller
#define task_ma_time
#include "TSISensor.h"

Serial pc(USBTX, USBRX);


BX_servo servo; 

BX_camera cam;

BX_motor MotorA('A');
BX_motor MotorB('B');

BX_pot pot1('1');

                                 // 90/30=3
PID cam_to_M_ctrlr(10.0,118.0,0.059,0.105,0.105-0.059,0.00,0.02,10);

DigitalOut task_pin(PTD1);
TSISensor tsi;
int main() {
    
    
       pc.baud(115200);
    
     while(1){
         
       if(tsi.readPercentage()>0.00011)
           break;
     }
     
    
     
     
      double motor;
     double b_r_c;
     double PID_v;
     while(1){
         
        #ifdef task_ma_time
             task_pin=1;
        #endif 
         
         
         
        cam.read();  
     
#ifdef Debug_cam_uart
      
      #ifdef L_eye  
        for(int i=0;i<128;i++){

              
              
              
             if(i==64)
               pc.printf("X");
             else          
               pc.printf("%c", cam.sign_line_imageL[i]);
         }
         pc.printf("           ||             ");
      #endif
      #ifdef R_eye
        for(int i=128;i>=0;i--){
             if(i==64)
               pc.printf("X");
             
             else if(i<10)
               pc.printf("-");
               
             else if(i>117)


              pc.printf("-");
             
             else          
               pc.printf("%c", cam.sign_line_imageR[i]);
         
           
            
            
               
         
         }
         pc.printf("\r\n");
         
         
       
     
     #endif
         
         
     
            
     
     
  
     
   

#endif   
     
      
     
     
     
     
     
     
     
       
         #ifdef motor_on 
           
     
             motor=pot1.read();
     
    
    
  
             MotorA.rotate(motor);
             MotorB.rotate(motor);
        #endif
       
       
       
       
       
         b_r_c=(double)cam.black_centerR();

         PID_v=cam_to_M_ctrlr.compute(b_r_c,64.0);
         
         
         
         #ifdef Debug_cam_uart
        
         pc.printf("cam %d %d      k:%f  i:%f  d:%f  speed :%f  bk_center %f PID:%f \r\n",cam.de_v,cam.de_v2,cam_to_M_ctrlr.de_kp,cam_to_M_ctrlr.de_ip,cam_to_M_ctrlr.de_dp,motor,b_r_c,PID_v);
         
         #endif
        servo.set_angle(PID_v);
        
      
       
     
      #ifdef task_ma_time
        task_pin=0;
        #endif 
        
     }
   
     
     
    
    
    
    
    return 0;
    
    
}