Robofun 機器人論壇

 找回密碼
 申請會員
搜索
熱搜: 活動 交友 discuz
查看: 1658|回復: 0
打印 上一主題 下一主題

請問FSR壓力感測器結合自走車

[複製鏈接]
跳轉到指定樓層
1#
發表於 2014-12-31 10:33:14 | 只看該作者 回帖獎勵 |倒序瀏覽 |閱讀模式
/*

 控制 兩個馬達    控制馬達轉速 使用PWM  功能




*/

// constants won't change. They're used here to
// set pin numbers:
const int sensorPinL = 2;     //
const int sensorPinR = 3;     //
int pwmR = 0;
int pwmL = 0;



const int motorLin1 =  10;      //    左馬達 電機控制  
const int motorLin2=  11;      //   左馬達  電機控制
const int motorRin1 =  12;      //    右馬達控制
const int motorRin2=  13;      //     左馬達控制

// variables will change:
int sensorStateL = 0;         //  左偵測器
int sensorStateR = 0;         //   右偵測器

void setup() {

  pinMode(motorRin1, OUTPUT);
  pinMode(motorRin2, OUTPUT);

  pinMode(sensorPinL, INPUT);  
  pinMode(sensorPinR, INPUT);   

  pinMode(5,OUTPUT);  // 控制左電機馬達轉速  PWM  


  pinMode(6,OUTPUT);

}

void loop(){
  // read the state of the pushbutton value:

  analogWrite(5,200);  //PWM  左馬達   

   analogWrite(6,200);  //PWM     右馬達

  sensorStateL = digitalRead(sensorPinL);
  sensorStateR = digitalRead(sensorPinR);
  // check if the pushbutton is pressed.
  // if it is, the buttonState is HIGH:

    if (sensorStateL == HIGH) {     
    // turn LED on:   
    digitalWrite(motorLin1, HIGH);
    digitalWrite(motorLin2, LOW);   
  }
  else {
    // turn LED off:
    digitalWrite(motorLin2, HIGH);
    digitalWrite(motorLin1, LOW);
  }


    if (sensorStateR == HIGH) {     
    // turn LED on:   
    digitalWrite(motorRin1, HIGH);
    digitalWrite(motorRin2, LOW);   
  }
  else {
    // turn LED off:
    digitalWrite(motorRin2, HIGH);
    digitalWrite(motorRin1, LOW);
  }

}
------------------------------------------------------------------------------------我是分割線
// 首先定義腳位
#define led_pin 11
#define fsr_pin A0

void setup()
{
  Serial.begin(115200);
  pinMode(led_pin, OUTPUT);
}

void loop()
{
  int fsr_value = analogRead(fsr_pin); // 讀取FSR
  int led_value = map(fsr_value, 0, 1023, 0, 255); // 從0~1023映射到0~255

analogWrite(led_pin, led_value); // 改變LED亮度
  Serial.println(fsr_value);
  Serial.println(led_value);
  Serial.println("-------------");
  delay(100);
}
----------------------------------------------------------------------------------------------分割線
請問這兩個程式該怎麼結合會比較好呢????
您需要登錄後才可以回帖 登錄 | 申請會員

本版積分規則

小黑屋|手機版|Archiver|機器人論壇 from 2005.07

GMT+8, 2024-9-28 03:13 , Processed in 0.234314 second(s), 8 queries , Apc On.

Powered by Discuz! X3.2

© 2001-2013 Comsenz Inc.

快速回復 返回頂部 返回列表