/*------------------------------------------------------------------------------------ 版权说明: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设置为低电平 } |
/*------------------------------------------------------------------------------------ 版权说明: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 turn_in_Place(); //程序初始化部分. void setup() { pinMode( 5 , OUTPUT); //将引脚5设置为输出模式 pinMode( 6 , OUTPUT); //将引脚6设置为输出模式 pinMode( 9 , OUTPUT); //将引脚9设置为输出模式 pinMode( 10 , OUTPUT); //将引脚10设置为输出模式 } //主程序部分 void loop() { turn_in_Place(); delay( 100 ); } //原地转向子程序封装. void turn_in_Place() { digitalWrite( 5 , LOW ); //将引脚5设置为高电平 digitalWrite( 6 , HIGH ); //将引脚6设置为低电平 digitalWrite( 9 , HIGH ); //将引脚9设置为高电平 digitalWrite( 10 , LOW); //将引脚10设置为低电平 } |
欢迎光临 机器人与人工智能爱好者论坛 (http://123.57.240.186/) | Powered by Discuz! X3.2 |