本帖最后由 技术弟弟 于 2012-3-20 14:15 编辑
想挣脱地心引力的束缚？想练习跑酷在垂直的墙壁上疾走？——不要用崇拜的目光注视我，虽然我就是飞檐走壁，仁者无敌的可爱玲珑Wallbots！当然我也不介意你称呼我的艺名：【蜘蛛侠】
墙面上爬来爬去的是神马？！莫要惊慌，既不是壁虎也不是变异蜘蛛，它们是可爱的Wallbots——能在垂直表面进行穿越的机器人。想知道怎么制作？嗯哼，往下看吧~小W可以在任何含金属墙面上移动，包括电梯，白板，冰箱、金属门。 小W还配备了几个光传感器，通过它们可以进行简单的交互。 3种模式可供选择，通过光传感器进行转换： 红色走得快，趋近障碍物（例如人的手或者小W的兄弟姐妹们）； 绿色走得慢，远离障碍； 黄色走得最慢，检测到物体时完全停止。 1 工具和材料
● 一些不易弯曲的硬线
● 绝缘胶布
● 线
● 硬板纸
● 胶棒
● 热胶q1an9
● 剪刀
● 剪钳（绞线的那个）
○ 2.2K欧姆电阻*4
○ 10K欧姆电阻
○ 100欧姆电阻
○ Arduino Mini（单片机）
○ 伺服电机*2
○ 磁铁片*6
○ 1个RGB LED灯
○ 1个轻型的电池
2 使伺服电机连续运转之入门篇
● 把固定它的壳子打开，对每个伺服机做简单修改就能得到我们需要的连续转动，先撬开壳子。
● 把妨碍转动的壳子剪掉，这样电位计就能一直获得连续信号。
● 这个黑色的部分是用来让它转了180度后停止的，看见没？两个黑色塑料小片儿。
● 取下齿轮
● 把黑色壳子上的线剪下（下一个大步会告诉你怎么处理它们）。
● 把挡着连续转动的小塑料片儿剪掉。
3 使伺服电机连续转动之进阶篇
● 现在，电位计已被成功调戏~(≧▽≦)/~，她一直采集连续信号。
● 从黑壳子上剪出红色，绿色和黄色的线（这个应当在上一步就做好了）。
● 绿色的线和黄色线之间焊个2.2K的电阻
● 在红色和黄色的线之间也焊个2.2K的电阻
4 反向设置
● 在相同模拟信号下，伺服机的转向一般是相同的。他们对称安装在小W上，但是要让一个反向怎么办？在硬件和软件上都可以解决（我用硬件做的，因为我是代码懒人，摔！）。
● 剪下电机到电机板子上的红色和蓝色的线。
● 焊接红线到蓝线，然后蓝线到红线（头晕了吧？其实就是像图上那样交叉一下）。
5 组装电机
● 这步很容易嘿！尽可能温柔滴把线塞到伺服机壳子里面，然后把齿轮装配好。可是捏，我加了电阻后，以前的壳子就不合适了，所以我用绝缘胶布把他们缠在一块儿的。
6 齿轮上阵
● 怎么附上去呢？我用的热胶，其实任何粘性强的玩意儿都可以使，先剪两根1英寸长的硬线。
● 把每根线用热胶粘在伺服机顶部的齿轮里面。线要对半，露一半出来！
● 在每根线的末端粘3个磁盘。磁盘也必须是对准中心！
7 伺服机与单片机对接
● 我用PIN 9和 PIN 10来驱动电机。
● Pin 9 ->伺服机1的橙线。
● Pin 10 ->伺服机2的橙线
● Ground ->伺服机1,2的黑线。
● VCC ->伺服机1，2的红线。
8 接光敏电阻
● 把每个光敏电阻（光传感器）都连到Arduino上，一共4个传感器，左、右、前、后。
● 每个光传感器的电路图下面有，传感器的一条线连接到VCC；另一条线连到10K和100欧姆的电阻上。10K电阻接地，100欧姆电阻连接输入端。每个传感器的输入（绿线）连到MINI上的模拟端口（A0,A1,A2,A3）。
● 我程序里是这样设置的：Analog 0 -> 顶部的传感器；Analog 1 -> 左边的传感器；Analog 2 -> 前面的传感器；Analog 3 -> 右边的传感器。
9 加上RGB LED灯
● 把每个光敏电阻（光传感器）都连到Arduino上，一共4个传感器，左、右、前、后。
● 你是不是想在每个端口和LED灯之间放个电阻（200 欧姆左右)？我没有酱紫，因为我的LED灯可以承受的电压比Arduino能提供的高得多，所以不会被烧。
10 安装电池● 其实捏，能提供3—4V的电池都可以用，越轻越好。我使用了sparkfun锂电池。接地，然后高压直接接Arduino的VCC口。
11 上程序！！● 这代码是关于2个伺服电机根据4个光传感器的输入值而进行驱动。根据模式，有几种运动方式。
- */
- #include
- // Right and left servos
- Servo servo1;
- Servo servo2;
- // Light Sensors
- int topSensor = 0; //700
- int leftSensor = 1; /// Threshhold is 400
- int frontSensor = 2; //400
- int rightSensor = 3; //300
- // Hardcoded thresholds (not used because we auto-calibrate)
- int topThreshhold = 400;
- int leftThreshhold = 550;
- int frontThreshhold = 200;
- int rightThreshhold = 650;
- // Current robot type (red gree or yellow)
- int STATE = 0;
- // State values
- int RED = 0;
- int GREEN = 1;
- int ORANGE = 2;
- // Pins to drive the top tri-color LED
- int redPin = 5;
- int greenPin = 6;
- // Values to hold sensor readings
- int front;
- int right;
- int left;
- int top;
- // Auto-calibrate light sensor thresholds
- void calibrate() {
- Serial.println("CALIBRAtiNG");
- long int val = 0;
- for (int i = 0; i<5; i++) {
- val += analogRead(frontSensor);
- delay(10);
- }
- frontThreshhold = (val /5) - 80;
- val = 0;
- for (int i = 0; i<5; i++) {
- val = val + analogRead(topSensor);
- Serial.println(analogRead(topSensor));
- Serial.println(val);
- delay(10);
- }
- topThreshhold = (val /5) -200;
- val = 0;
- for (int i = 0; i<5; i++) {
- val += analogRead(rightSensor);
- }
- rightThreshhold = (val /5) - 100;
- val = 0;
- for (int i = 0; i<5; i++) {
- val += analogRead(leftSensor);
- }
- leftThreshhold = (val /5) - 100;
- // Print threshold values for debug
- Serial.print("top: ");
- Serial.println(topThreshhold);
- Serial.print("right: ");
- Serial.println(rightThreshhold);
- Serial.print("left: ");
- Serial.println(leftThreshhold);
- Serial.print("front: ");
- Serial.println(frontThreshhold);
- }
- void setup()
- {
- // turn on pin 13 for debug
- pinMode(13, OUTPUT);
- digitalWrite(13, HIGH);
- // setup sensor pins
- for (int i = 0; i<4; i++) {
- pinMode(i, INPUT);
- }
- Serial.begin(9600);
- calibrate();
- // generate a random state
- STATE = random(0, 3);
- setColor(STATE);
- }
- // MOTOR FUNCTIONS
- void turnLeft()
- {
- Serial.println("LEFT");
- start();
- delay(20);
- for (int i = 0; i<20; i++) {
- servo2.write(179);
- servo1.write(1);
- delay(20);
- }
- stop();
- delay(20);
- }
- void turnRight() {
- Serial.println("RIGHT");
- start();
- delay(20);
- for (int i = 0; i<20; i++) {
- servo2.write(1);
- servo1.write(179);
- delay(20);
- }
- stop();
- delay(20);
- }
- void goForward(int del = 20) {
- Serial.println("FORWARD");
- start();
- delay(20);
- for (int i = 0; i<20; i++) {
- servo1.write(179);
- servo2.write(179);
- delay(del);
- }
- stop();
- delay(20);
- }
- void stop() {
- servo1.detach();
- servo2.detach();
- delay(10);
- }
- void start() {
- servo1.attach(10);
- servo2.attach(9);
- }
- // Set the color of the top tri-color LED based on the current state
- void setColor(int color) {
- if (color == RED) {
- digitalWrite(greenPin, 0);
- analogWrite(redPin, 180);
- }
- else if (color == GREEN) {
- digitalWrite(redPin, 0);
- analogWrite(greenPin, 180);
- }
- else if (color == ORANGE) {
- analogWrite(redPin, 100);
- analogWrite(greenPin, 100);
- }
- }
- // Blink the yellow color (when robot is confused)
- void blinkOrange() {
- for (int i = 0; i<5; i++) {
- analogWrite(redPin, 100);
- analogWrite(greenPin, 100);
- delay(300);
- digitalWrite(redPin, 0);
- digitalWrite(greenPin, 0);
- delay(300);
- }
- analogWrite(redPin, 100);
- analogWrite(greenPin, 100);
- }
- void loop()
- {
- top = analogRead(topSensor);
- long int time = millis();
- while (analogRead(topSensor) < topThreshhold) {
- delay(10); // while there is an arm wave from the user don't do anything
- }
- if ((millis() - time) > 3000) {
- // if the sensor was covered for more than 3 seconds, re-calibrate
- calibrate();
- }
- // if the top sensor was covered, we change state
- if (top < topThreshhold) {
- STATE = (STATE+1) %3;
- setColor(STATE);
- Serial.print("CHANGED STATE: ");
- Serial.println(STATE);
- }
- // Read the other sensors
- right = analogRead(rightSensor);
- left = analogRead(leftSensor);
- front = analogRead(frontSensor);
- if (STATE == RED) {
- // go towards objects
- if (front < frontThreshhold) {
- goForward();
- } else if (right < rightThreshhold) {
- turnRight();
- } else if (left
- turnLeft();
- } else {
- goForward();
- }
- }
- if (STATE == GREEN) {
- // go away from objects
- if (front < frontThreshhold) {
- int dir = random(0,2);
- if (dir == 0 && right > rightThreshhold) {
- turnRight();
- } else if (dir == 1 && left > leftThreshhold) {
- turnLeft();
- }
- } else if (right < rightThreshhold) {
- if (left > leftThreshhold) {
- turnLeft();
- } else {
- goForward();
- }
- } else if (left
- if (right > rightThreshhold) {
- turnRight();
- } else {
- goForward();
- }
- } else {
- goForward();
- }
- delay(200);
- }
- if (STATE == ORANGE) {
- // only move if there are no hand motions- otherwise blink
- int dir = random(0, 3);
- if (left
- front
- blinkOrange();
- } else {
- if (dir == 0) {
- goForward();
- } else if (dir == 1) {
- turnRight();
- } else if (dir == 2) {
- turnLeft();
- }
- delay(1000);
- }
- delay(10);
- }
- }
红色最快，趋向物体（当光传感器检测到光被挡住时）；
蓝色是中速，背向物体（背向黑色区域）；
黄色最慢，检测到物体就停止。
● 小W和它的兄弟姐妹们通过磁铁轮子在墙上运动，可以左转右转和前行；根据不同模式可进行调速。
● 当顶部的传感器被遮住超过3秒，所有传感器自动校准。
12 别让小W裸奔
|
|
|
|
|
|
|
/6 
工商网监
湘ICP备2023018690号
34695
评论
淘帖
20086
