/*------------------------------------------------------------------------------------ 版权说明: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-31 https://www.robotway.com/ ------------------------------ 实验功能: 实现斜三角履带底盘前进. ----------------------------------------------------- 实验接线: 左侧车轮接 ![]() | | .-----------------------------------. | | | |-------. | |【车头】| | |-------* | | *-----------------------------------* | | 右侧车轮接 ![]() ------------------------------------------------------------------------------------*/ void Forward(); // 前进 //程序初始化部分:设置电机引脚为输出模式 void setup() { pinMode( 5 , OUTPUT); //将引脚5设置为输出模式 pinMode( 6 , OUTPUT); //将引脚6设置为输出模式 pinMode( 9 , OUTPUT); //将引脚9设置为输出模式 pinMode( 10 , OUTPUT);//将引脚10设置为输出模式 } //主程序部分:小车前进 void loop() { Forward(); } //封装小车前进动作子程序 void Forward() { digitalWrite( 5 , LOW ); //右轮前进 digitalWrite( 6 , HIGH ); digitalWrite( 9 , LOW ); //左轮前进 digitalWrite( 10 , HIGH ); } |
/*------------------------------------------------------------------------------------ 版权说明: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-31 https://www.robotway.com/ -------------------------- 实验功能: 实现斜三角履带底盘后退. ---------------------------------------------------- 实验接线: 左侧车轮接 ![]() | | .-----------------------------------. | | | |-------. | |【车头】| | |-------* | | *-----------------------------------* | | 右侧车轮接 ![]() ------------------------------------------------------------------------------------*/ void Backward();// 后退 //程序初始化部分:设置电机引脚为输出模式 void setup() { pinMode( 5 , OUTPUT); //将引脚5设置为输出模式 pinMode( 6 , OUTPUT); //将引脚6设置为输出模式 pinMode( 9 , OUTPUT); //将引脚9设置为输出模式 pinMode( 10 , OUTPUT);//将引脚10设置为输出模式 } //主程序部分:小车后退 void loop(){ Backward(); } //封装小车后退动作子程序 void Backward() { digitalWrite( 5 , HIGH ); //右轮后退 digitalWrite( 6 , LOW ); digitalWrite( 9 , HIGH ); //左轮后退 digitalWrite( 10 , LOW); } |
/*------------------------------------------------------------------------------------ 版权说明: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-31 https://www.robotway.com/ ------------------------------------ 实验功能: 实现斜三角履带底盘原地旋转(差速方式). 本实验现象为四轮四驱底盘原地左转. ---------------------------------------------------- 实验接线: 左侧车轮接 ![]() | | .-----------------------------------. | | | |-------. | |【车头】| | |-------* | | *-----------------------------------* | | 右侧车轮接 ![]() ------------------------------------------------------------------------------------*/ void turn_Left(); // 原地转向(本示例为原地左转) //程序初始化部分:设置电机引脚为输出模式 void setup() { pinMode( 5 , OUTPUT); //将引脚5设置为输出模式 pinMode( 6 , OUTPUT); //将引脚6设置为输出模式 pinMode( 9 , OUTPUT); //将引脚9设置为输出模式 pinMode( 10 , OUTPUT);//将引脚10设置为输出模式 } //主程序部分:小车差速自转[本示例为小车左转] void loop() { turn_Left(); } //封装小车自转动作子程序(本示例为左转) void turn_Left(){ digitalWrite( 5 , LOW ); //右轮前进 digitalWrite( 6 , HIGH ); digitalWrite( 9 , HIGH ); //左轮后退 digitalWrite( 10 , LOW); } |
/*------------------------------------------------------------------------------------ 版权说明: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-31 https://www.robotway.com/ -------------------------------------------------------- 实验功能: 实现斜三角履带底盘大半径转向(原理为小车车轮同向不同速) -------------------------------------------------------- 实验接线: 左侧车轮接 ![]() | | .-----------------------------------. | | | |-------. | |【车头】| | |-------* | | *-----------------------------------* | | 右侧车轮接 ![]() ------------------------------------------------------------------------------------*/ void big_Turn();// 大半径转向 //程序初始化部分:设置电机引脚为输出模式 void setup() { pinMode( 5 , OUTPUT); //将引脚5设置为输出模式 pinMode( 6 , OUTPUT); //将引脚6设置为输出模式 pinMode( 9 , OUTPUT); //将引脚9设置为输出模式 pinMode( 10 , OUTPUT);//将引脚10设置为输出模式 } //主程序部分:小车走弧形路径 void loop() { big_Turn(); } //封装小车走大半径(弧线)动作子程序(同向不同速) void big_Turn() { analogWrite( 5 , 0 ); //右轮以255速度前进 analogWrite( 6 , 255); analogWrite( 9 , 0 ); //左轮以150速度前进 analogWrite( 10 , 150 ); } |
欢迎光临 机器人与人工智能爱好者论坛 (http://robot-ai.org/) | Powered by Discuz! X3.2 |