diy写字机器人_自己动手做一个写字机器人

#include

#include

Servo myservo;

int i = 87;//舵机中间位置 i为舵机位置指示参数

int x=30; //笔位置(笔尖到转轴的距离)

int led = 13;//中断指示灯

int c=0;

int s=0;

int u=0;

int v=0;

volatile int state = 0;

void setup() {

pinMode(A1, OUTPUT);

pinMode(A2, OUTPUT);

pinMode(A3, OUTPUT);

pinMode(A4, OUTPUT);

pinMode(3, INPUT_PULLUP);

pinMode(4, INPUT_PULLUP);

pinMode(5, INPUT_PULLUP);

pinMode(6, INPUT_PULLUP);

pinMode(7, INPUT_PULLUP);

pinMode(8, INPUT_PULLUP);

pinMode(led, OUTPUT);

attachInterrupt(0, blink, CHANGE);

myservo.attach(9);

Serial.begin(9600);

}

void loop() {

//myservo.write(87);

//Serial.println(s);

begain();

shoudong();

//sanjiao();

del