这几天写了写机械狗子的代码,使用十个舵机,分别当做狗子的头,脖子,四只脚和四条腿,来模拟狗子的各种动作,加了接触传感器,来做一些好玩的互动。我是看到淘宝https://item.taobao.com/item.htm?spm=a230r.1.14.1.3f2e7bdf1Bt4hj&id=585685365716&ns=1&abbucket=5#detail 四百多买一个成本不足一百的东西,有点亏
以下是代码:
#include <Servo.h>
#include "Adafruit_APDS9960.h"
#define ditou 30
#define pingshi 45
#define taitou 60
#define zuo 60
#define you 120
#define zhishi 90
uint8_t flagup = 30;
uint8_t flagri = 90;
Adafruit_APDS9960 apds;
Servo head, bozi, rfoot, rleg, lfoot, lleg, rfeet, rlegs, lfeet, llegs;
void setup()
{
Serial.begin(115200);
pinset();
apds9960INIT();
setzero();
}
void loop()
{
int i = random(10);
uint8_t data = handleGesture();
Serial.println(data);
if (data<10)
{
switch (data){
case 1:
flagup = taitou;
break;
case 2:
flagup = ditou;
break;
case 3:
flagri = zuo;
break;
case 4:
flagri = you;
break;
default:
break;
}
}
else
{
if (data>200)
{
flagup = pingshi;
flagri = zhishi;
}
}
stand();
switch (i) {
case 0:
huifu();
break;
case 1:
lanyao();
break;
case 2:
run();
break;
case 3:
qiandun();
break;
case 4:
houdun();
break;
case 5:
woshou();
break;
case 6:
xuxu();
break;
case 7: