/*------------------------------------------------------------------------------------
  版权说明：Copyright 2022 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 机器谱 2022-5-26 https://www.robotway.com/
  --------------------------------
  实验功能：
          实现小车前进.
  --------------------------------
  实验接线：
                车头
             .--------.
             |        |
             |        |
       左轮   |       |  右轮
      D5, D6 *--------* D9, D10
 ----------------------------------------------------------------------------------*/

void Forward(); // 前进

//程序初始化部分.
void setup() {
  pinMode( 5 , OUTPUT);  //将引脚5设置为输出模式
  pinMode( 6 , OUTPUT);  //将引脚6设置为输出模式
  pinMode( 9 , OUTPUT);  //将引脚9设置为输出模式
  pinMode( 10 , OUTPUT); //将引脚10设置为输出模式
}

//主程序部分
void loop()
{
  Forward();
  delay( 100 );
}

// forward子程序封装.
void Forward() {
  digitalWrite( 5 , LOW );  //将引脚5设置为高电平
  digitalWrite( 6 , HIGH ); //将引脚6设置为低电平
  digitalWrite( 9 , LOW );  //将引脚9设置为高电平
  digitalWrite( 10 , HIGH); //将引脚10设置为低电平
}