chia-hsun wu / Mbed 2 deprecated Boboobooov10

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed-rtos mbed

Fork of Boboobooov4 by kao yi

main.cpp

Committer:
backman
Date:
2014-06-22
Revision:
7:fd976e1ced33
Parent:
6:5a39bde2e016
Child:
8:8e49e21d80a2

File content as of revision 7:fd976e1ced33:

#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

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(3.0,0.0,0.0,10);

//DigitalOut task_pin(PTD1);

int main() {
    
     
     
     pc.baud(115200);
     
     
      double motor;
     int b_r_c;
     
     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   
     
      
     
     
     
     
     
       b_r_c=cam.black_centerR();
     
     
       
         #ifdef motor_on 
           
     
             motor=pot1.read();
     
    
    
  
             MotorA.rotate(motor);
             MotorB.rotate(motor);
        #endif
       
       
       
       
       
        
     
         pc.printf("speed :%f  bk_center %d \r\n",motor,b_r_c);
       
        //servo.set_angle(cam_to_M_ctrlr.compute(b_r_c,30.0));
       
     
      #ifdef task_ma_time
        task_pin=0;
        #endif 
        
     }
   
     
     
    
    
    
    
    return 0;
    
    
}