Basra主控板（兼容Arduino Uno）‍

Bigfish2.1扩展板‍

传感器

光强传感器

通信

蓝牙串口模块

  版权说明：Copyright 2023 Robottime(Beijing) Technology Co., Ltd. All Rights Reserved.

           Distributed under MIT license.See file LICENSE for detail or copy at

           https://opensource.org/licenses/MIT

           by 机器谱 2023-10-25 https://www.robotway.com/

  ------------------------------*/

/*

* Light测试例程

* 2018/04/17

* ————————————

* 接线：

*    灯带：9、10

*    舵机：4

*    蓝牙：Bigfish扩展坞

*    光强：A0

* ————————————

* 功能：

*    控制模式：蓝牙控制灯叶开合

*    自主模式：光强传感器控制灯叶开合

*   

*    灯叶打开，灯亮；灯叶闭合，灯灭

*/

#include <ServoTimer2.h>

#include "light.h"

ServoTimer2 myServo;

int servo_port = 4;       //定义舵机引脚

int sensor_port = A0;     //定义光强传感器引脚

int servo_value = 1550;   //定义舵机初始值 PWM

/*

int open_angle = 1150;    //灯叶打开时舵机的值

int close_angle = 1550;   //灯叶闭合时舵机的值

*/

void setup() {

  Serial.begin(9600);

  PortInit();

  myServo.write(servo_value);

  delay(1000);

}

void loop() {

  /*Bluetooth Mode*/   

  if(SerialRead() == '1'){

    Serial.println("Bluetooth Mode");

    while(true){

      switch(SerialRead()){

        case '2':

          Serial.println("OPEN");

          ServoGo(1150);   //OPEN

        break;

        case '3':

          Serial.println("CLOSE");

          ServoGo(1550);   //CLOSE

        break;

        default:break;

      }

      if(SerialRead() == '4') {

        Serial.println("Auto Mode");

        break;

      }

    }

  }

  /* Auto Mode*/

  AutoMode();  

}

/*端口初始化*/

void PortInit(){

  pinMode(sensor_port, INPUT);

  pinMode(servo_port, OUTPUT);

  pinMode(9, OUTPUT);

  pinMode(10, OUTPUT);

  digitalWrite(9, LOW);

  digitalWrite(10, LOW);

  myServo.attach(servo_port);

}

/*串口控制*/

char SerialRead(){

  char c;

  while(Serial.available()) {

    c = Serial.read();  

  }

  return c;

}

/*自主模式*/

void AutoMode(){

  if(digitalRead(sensor_port)){   //亮光下，光强返回值1，灯叶闭合，灯光关闭

    ServoGo(1550);

  }

  if(!digitalRead(sensor_port)){   //黑暗中，光强返回0，灯叶打开，灯光开启

    ServoGo(1150);

  }

}

/*舵机控制*/

void ServoGo(int where){   //舵机控制函数，参数：目标角度

  int delta = where - servo_value;    //delta < 0: OPEN ; delta > 0: CLOSE

  if(delta == 0) return;

  float light_value = delta < 0 ? 0 : 255;   

  int diff = delta < 0 ? -1 : 1;

  for(int i=0;i<abs(delta);i++){

    servo_value += diff;

    if(delta < 0){

      light_value += 0.65;   //0.65 (255 / delta);

      if(light_value > 255) light_value = 255;

    }else if(delta > 0){

      light_value -= 0.65;

      if(light_value < 0) light_value = 0;

    }

    LightState(&light_value);  

    myServo.write(servo_value);

    delay(10);  

  }

}

/*灯光控制*/

void LightState(float * value){

  analogWrite(9, *value);

  analogWrite(10, 0);

}

程序源代码

样机3D文件