Injo Kim / Mbed 2 deprecated Smart_cruz_control_

hi

Dependencies:   mbed Servo

Laser.cpp

Committer:
injokim
Date:
2018-12-09
Revision:
0:b9dc28a0bfcc

File content as of revision 0:b9dc28a0bfcc:

#include "header.h"

DigitalIn   LaserSensor(D2);
DigitalOut  my_led(LED1);
PwmOut      my_servo(PB_0);

int Laser()
{ 
    int cmd; 
    
    if(LaserSensor == 1)
    {
        my_led = 0;
        cmd=0;
    }
                                  
    else
    {
        my_led = 1;
        cmd=1;
    }
    wait(0.1);
    return cmd;
}

void Laser_servo(int i)
{
    if (i==1)
      {  
        my_servo.period_ms(20);
        my_servo.write(0.1);
      }
      
      else
      {
        my_servo.period_ms(20);
        my_servo.write(0.25);
      }
}