小新手 發表於 2017-12-28 18:58:37

想請問兩塊感應器的程式合併問題 (已解決)

本帖最後由 小新手 於 2017-12-29 20:45 編輯

我目前這裡有一個感應心跳後藍芽傳送的程式和gps定位的程序,我想將兩個結合在一起讓他可以同時運作,可是合併後,雖然心跳的部分沒有問題,藍芽也是都能順利連上手機並顯示心跳和GPS的訊息,不過gps部分總是一直沒收到訊號,可以請教各位大師我哪裡錯了嗎?:Q (用心跳程序當基底將gps寫上去)
心跳採用pluse sensor 藍芽採用hc-05 gps採用neo-6m
因為有點長如果看不下去的話請點這裡下程式碼QAQ : https://drive.google.com/open?id=1qcauSNLs1zAEQz1L2kD7qXPZSihbP--H
原來的藍芽pluse sensor(pluse seror分成3個檔案了)


(心跳第一個PulseSensor_wt_BT.ino)
#include <SoftwareSerial.h>// import the serial library

SoftwareSerial Genotronex(10, 11); // RX, TX
int ledpin=12; // led on D13 will show blink on / off
int BluetoothData; // the data given from Computer

//Variables
int pulsePin = 0;               // Pulse Sensor purple wire connected to analog pin 0
int blinkPin = 13;                // pin to blink led at each beat
int fadePin = 5;                  // pin to do fancy classy fading blink at each beat
int fadeRate = 0;               // used to fade LED on with PWM on fadePin

// Volatile Variables, used in the interrupt service routine!
volatile int BPM;                   // int that holds raw Analog in 0. updated every 2mS
volatile int Signal;                // holds the incoming raw data
volatile int IBI = 600;             // int that holds the time interval between beats! Must be seeded!
volatile boolean Pulse = false;   // "True" when User's live heartbeat is detected. "False" when not a "live beat".
volatile boolean QS = false;      // becomes true when Arduoino finds a beat.

// Regards Serial OutPut-- Set This Up to your needs
static boolean serialVisual = true;   // Set to 'false' by Default.Re-set to 'true' to see Arduino Serial Monitor ASCII Visual Pulse


void setup(){
pinMode(blinkPin,OUTPUT);         // pin that will blink to your heartbeat!
pinMode(fadePin,OUTPUT);          // pin that will fade to your heartbeat!
Serial.begin(115200);             // we agree to talk fast!
interruptSetup();               // sets up to read Pulse Sensor signal every 2mS
   // UN-COMMENT THE NEXT LINE IF YOU ARE POWERING The Pulse Sensor AT LOW VOLTAGE,
   // AND APPLY THAT VOLTAGE TO THE A-REF PIN
//   analogReference(EXTERNAL);   
Genotronex.begin(9600);
Genotronex.println("Bluetooth On please press 1 or 0 blink LED ..");
pinMode(ledpin,OUTPUT);
}


//Where the Magic Happens
void loop(){

    serialOutput() ;      
   
if (QS == true){   //A Heartbeat Was Found
                     // BPM and IBI have been Determined
                     // Quantified Self "QS" true when arduino finds a heartbeat
      digitalWrite(blinkPin,HIGH);   // Blink LED, we got a beat.
      fadeRate = 255;         // Makes the LED Fade Effect Happen
                              // Set 'fadeRate' Variable to 255 to fade LED with pulse
      serialOutputWhenBeatHappens();   // A Beat Happened, Output that to serial.   
      QS = false;                      // reset the Quantified Self flag for next time   
       }
      else {

      digitalWrite(blinkPin,LOW);            // There is not beat, turn off pin 13 LED
      }
   
   ledFadeToBeat();                      // Makes the LED Fade Effect Happen
if (Genotronex.available()){
BluetoothData=Genotronex.read();
   if(BluetoothData=='1'){   // if number 1 pressed ....
   digitalWrite(ledpin,1);
   Genotronex.println("LEDOn D12 ON ! ");
   }
if (BluetoothData=='0'){// if number 0 pressed ....
digitalWrite(ledpin,0);
   Genotronex.println("LEDOn D12 Off ! ");
}
}
delay(20);                           //take a break
}


心跳第二個(AllSerialHandling.ino)
void serialOutput(){   // Decide How To Output Serial.
if (serialVisual == true){
   arduinoSerialMonitorVisual('-', Signal);   // goes to function that makes Serial Monitor Visualizer
} else{
      sendDataToSerial('S', Signal);   // goes to sendDataToSerial function
}      
}


//Decides How To OutPut BPM and IBI Data
void serialOutputWhenBeatHappens(){   
if (serialVisual == true){            //Code to Make the Serial Monitor Visualizer Work
    Serial.print("*** Heart-Beat Happened *** ");//ASCII Art Madness
    Serial.print("BPM: ");
   Genotronex.println("HEART RATE IS");
      Genotronex.println(BPM);
    Serial.print(BPM);
    Serial.print("");
} else{
      sendDataToSerial('B',BPM);   // send heart rate with a 'B' prefix
      sendDataToSerial('Q',IBI);   // send time between beats with a 'Q' prefix
}   
}



//Sends Data to Pulse Sensor Processing App, Native Mac App, or Third-party Serial Readers.
void sendDataToSerial(char symbol, int data ){
    Serial.print(symbol);

    Serial.println(data);               
}





void ledFadeToBeat(){
    fadeRate -= 15;                         //set LED fade value
    fadeRate = constrain(fadeRate,0,255);   //keep LED fade value from going into negative numbers!
    analogWrite(fadePin,fadeRate);          //fade LED
}


//Code to Make the Serial Monitor Visualizer Work
void arduinoSerialMonitorVisual(char symbol, int data ){   
const int sensorMin = 0;      // sensor minimum, discovered through experiment
const int sensorMax = 1024;    // sensor maximum, discovered through experiment

int sensorReading = data;
// map the sensor range to a range of 12 options:
int range = map(sensorReading, sensorMin, sensorMax, 0, 11);

// do something different depending on the
// range value:
switch (range) {
case 0:   
    Serial.println("");   /////ASCII Art Madness
    break;
case 1:   
    Serial.println("---");
    break;
case 2:   
    Serial.println("------");
    break;
case 3:   
    Serial.println("---------");
    break;
case 4:   
    Serial.println("------------");
    break;
case 5:   
    Serial.println("--------------|-");
    break;
case 6:   
    Serial.println("--------------|---");
    break;
case 7:   
    Serial.println("--------------|-------");
    break;
case 8:
    Serial.println("--------------|----------");
    break;
case 9:   
    Serial.println("--------------|----------------");
    break;
case 10:   
    Serial.println("--------------|-------------------");
    break;
case 11:   
    Serial.println("--------------|-----------------------");
    break;

}
}




小新手 發表於 2017-12-28 19:00:42

本帖最後由 小新手 於 2017-12-28 19:16 編輯

心跳第三個(Interrupt.ino)
volatile int rate;                  // array to hold last ten IBI values
volatile unsigned long sampleCounter = 0;          // used to determine pulse timing
volatile unsigned long lastBeatTime = 0;         // used to find IBI
volatile int P =512;                      // used to find peak in pulse wave, seeded
volatile int T = 512;                     // used to find trough in pulse wave, seeded
volatile int thresh = 525;                // used to find instant moment of heart beat, seeded
volatile int amp = 100;                   // used to hold amplitude of pulse waveform, seeded
volatile boolean firstBeat = true;      // used to seed rate array so we startup with reasonable BPM
volatile boolean secondBeat = false;      // used to seed rate array so we startup with reasonable BPM


void interruptSetup(){   
// Initializes Timer2 to throw an interrupt every 2mS.
TCCR2A = 0x02;   // DISABLE PWM ON DIGITAL PINS 3 AND 11, AND GO INTO CTC MODE
TCCR2B = 0x06;   // DON'T FORCE COMPARE, 256 PRESCALER
OCR2A = 0X7C;      // SET THE TOP OF THE COUNT TO 124 FOR 500Hz SAMPLE RATE
TIMSK2 = 0x02;   // ENABLE INTERRUPT ON MATCH BETWEEN TIMER2 AND OCR2A
sei();             // MAKE SURE GLOBAL INTERRUPTS ARE ENABLED      
}


// THIS IS THE TIMER 2 INTERRUPT SERVICE ROUTINE.
// Timer 2 makes sure that we take a reading every 2 miliseconds
ISR(TIMER2_COMPA_vect){                         // triggered when Timer2 counts to 124
cli();                                    // disable interrupts while we do this
Signal = analogRead(pulsePin);            // read the Pulse Sensor
sampleCounter += 2;                         // keep track of the time in mS with this variable
int N = sampleCounter - lastBeatTime;       // monitor the time since the last beat to avoid noise

    //find the peak and trough of the pulse wave
if(Signal < thresh && N > (IBI/5)*3){       // avoid dichrotic noise by waiting 3/5 of last IBI
    if (Signal < T){                        // T is the trough
      T = Signal;                         // keep track of lowest point in pulse wave
    }
}

if(Signal > thresh && Signal > P){          // thresh condition helps avoid noise
    P = Signal;                           // P is the peak
}                                        // keep track of highest point in pulse wave

//NOW IT'S TIME TO LOOK FOR THE HEART BEAT
// signal surges up in value every time there is a pulse
if (N > 250){                                 // avoid high frequency noise
    if ( (Signal > thresh) && (Pulse == false) && (N > (IBI/5)*3) ){      
      Pulse = true;                               // set the Pulse flag when we think there is a pulse
//      digitalWrite(blinkPin,HIGH);                // turn on pin 13 LED
      IBI = sampleCounter - lastBeatTime;         // measure time between beats in mS
      lastBeatTime = sampleCounter;               // keep track of time for next pulse

      if(secondBeat){                        // if this is the second beat, if secondBeat == TRUE
      secondBeat = false;                  // clear secondBeat flag
      for(int i=0; i<=9; i++){             // seed the running total to get a realisitic BPM at startup
          rate = IBI;                     
      }
      }

      if(firstBeat){                         // if it's the first time we found a beat, if firstBeat == TRUE
      firstBeat = false;                   // clear firstBeat flag
      secondBeat = true;                   // set the second beat flag
      sei();                               // enable interrupts again
      return;                              // IBI value is unreliable so discard it
      }   


      // keep a running total of the last 10 IBI values
      word runningTotal = 0;                  // clear the runningTotal variable   

      for(int i=0; i<=8; i++){                // shift data in the rate array
      rate = rate;                  // and drop the oldest IBI value
      runningTotal += rate;            // add up the 9 oldest IBI values
      }

      rate = IBI;                        // add the latest IBI to the rate array
      runningTotal += rate;                // add the latest IBI to runningTotal
      runningTotal /= 10;                     // average the last 10 IBI values
      BPM = 60000/runningTotal;               // how many beats can fit into a minute? that's BPM!
      QS = true;                              // set Quantified Self flag
      // QS FLAG IS NOT CLEARED INSIDE THIS ISR
    }                     
}

if (Signal < thresh && Pulse == true){   // when the values are going down, the beat is over
//    digitalWrite(blinkPin,LOW);            // turn off pin 13 LED
    Pulse = false;                         // reset the Pulse flag so we can do it again
    amp = P - T;                           // get amplitude of the pulse wave
    thresh = amp/2 + T;                  // set thresh at 50% of the amplitude
    P = thresh;                            // reset these for next time
    T = thresh;
}

if (N > 2500){                           // if 2.5 seconds go by without a beat
    thresh = 512;                        // set thresh default
    P = 512;                               // set P default
    T = 512;                               // set T default
    lastBeatTime = sampleCounter;          // bring the lastBeatTime up to date      
    firstBeat = true;                      // set these to avoid noise
    secondBeat = false;                  // when we get the heartbeat back
}

sei();                                 // enable interrupts when youre done!
}// end isr


GPS部分

#include <SoftwareSerial.h>
#include <TinyGPS.h>

SoftwareSerial mySerial(10, 11);
TinyGPS gps;

void gpsdump(TinyGPS &gps);
void printFloat(double f, int digits = 2);

void setup()
{
// Oploen serial communications and wait for port to open:
Serial.begin(9600);
// set the data rate for the SoftwareSerial port
mySerial.begin(9600);
delay(1000);
Serial.println("uBlox Neo 6M");
Serial.print("Testing TinyGPS library v. "); Serial.println(TinyGPS::library_version());
Serial.println("by Mikal Hart");
Serial.println();
Serial.print("Sizeof(gpsobject) = ");
Serial.println(sizeof(TinyGPS));
Serial.println();
}

void loop() // run over and over
{
bool newdata = false;
unsigned long start = millis();
// Every 5 seconds we print an update
while (millis() - start < 5000)
{
    if (mySerial.available())
   
    {
      char c = mySerial.read();
      //Serial.print(c);// uncomment to see raw GPS data
      if (gps.encode(c))
      {
      newdata = true;
      break;// uncomment to print new data immediately!
      }
    }
}

if (newdata)
{
    Serial.println("Acquired Data");
    Serial.println("-------------");
    gpsdump(gps);
    Serial.println("-------------");
    Serial.println();
}

}

void gpsdump(TinyGPS &gps)
{
long lat, lon;
float flat, flon;
unsigned long age, date, time, chars;
int year;
byte month, day, hour, minute, second, hundredths;
unsigned short sentences, failed;

gps.get_position(&lat, &lon, &age);
Serial.print("Lat/Long(10^-5 deg): "); Serial.print(lat); Serial.print(", "); Serial.print(lon);
Serial.print(" Fix age: "); Serial.print(age); Serial.println("ms.");

// On Arduino, GPS characters may be lost during lengthy Serial.print()
// On Teensy, Serial prints to USB, which has large output buffering and
//   runs very fast, so it's not necessary to worry about missing 4800
//   baud GPS characters.

gps.f_get_position(&flat, &flon, &age);
Serial.print("Lat/Long(float): "); printFloat(flat, 5); Serial.print(", "); printFloat(flon, 5);
    Serial.print(" Fix age: "); Serial.print(age); Serial.println("ms.");

gps.get_datetime(&date, &time, &age);
Serial.print("Date(ddmmyy): "); Serial.print(date); Serial.print(" Time(hhmmsscc): ");
    Serial.print(time);
Serial.print(" Fix age: "); Serial.print(age); Serial.println("ms.");

gps.crack_datetime(&year, &month, &day, &hour, &minute, &second, &hundredths, &age);
Serial.print("Date: "); Serial.print(static_cast<int>(month)); Serial.print("/");
    Serial.print(static_cast<int>(day)); Serial.print("/"); Serial.print(year);
Serial.print("Time: "); Serial.print(static_cast<int>(hour+8));Serial.print(":"); //Serial.print("UTC +08:00 Malaysia");
    Serial.print(static_cast<int>(minute)); Serial.print(":"); Serial.print(static_cast<int>(second));
    Serial.print("."); Serial.print(static_cast<int>(hundredths)); Serial.print(" UTC +08:00 Malaysia");
Serial.print("Fix age: ");Serial.print(age); Serial.println("ms.");
Serial.print("Alt(cm): "); Serial.print(gps.altitude()); Serial.print(" Course(10^-2 deg): ");
    Serial.print(gps.course()); Serial.print(" Speed(10^-2 knots): "); Serial.println(gps.speed());
Serial.print("Alt(float): "); printFloat(gps.f_altitude()); Serial.print(" Course(float): ");
    printFloat(gps.f_course()); Serial.println();
Serial.print("Speed(knots): "); printFloat(gps.f_speed_knots()); Serial.print(" (mph): ");
    printFloat(gps.f_speed_mph());
Serial.print(" (mps): "); printFloat(gps.f_speed_mps()); Serial.print(" (kmph): ");
    printFloat(gps.f_speed_kmph()); Serial.println();

gps.stats(&chars, &sentences, &failed);
Serial.print("Stats: characters: "); Serial.print(chars); Serial.print(" sentences: ");
    Serial.print(sentences); Serial.print(" failed checksum: "); Serial.println(failed);
}





小新手 發表於 2017-12-28 19:02:29

本帖最後由 小新手 於 2017-12-28 19:19 編輯

void printFloat(double number, int digits)
{
// Handle negative numbers
if (number < 0.0)
{
   Serial.print('-');
   number = -number;
}

// Round correctly so that print(1.999, 2) prints as "2.00"
double rounding = 0.5;
for (uint8_t i=0; i<digits; ++i)
    rounding /= 10.0;

number += rounding;

// Extract the integer part of the number and print it
unsigned long int_part = (unsigned long)number;
double remainder = number - (double)int_part;
Serial.print(int_part);

// Print the decimal point, but only if there are digits beyond
if (digits > 0)
    Serial.print(".");

// Extract digits from the remainder one at a time
while (digits-- > 0)
{
    remainder *= 10.0;
    int toPrint = int(remainder);
    Serial.print(toPrint);
    remainder -= toPrint;
}
}


接下來是以心跳藍芽為基底合併後的程式碼(INTERRUPPT的程式沒有變動,然後將Genotronex改為btSerial,myserial改為gpsSerial並錯開腳位))個人覺得是rxd txd的問題,不知道是不是,請問怎麼解決才好

合併後的第一個程式(PulseSensor_wt_BTGPS.ino)

#include <SoftwareSerial.h>// import the serial library
#include <TinyGPS.h>
SoftwareSerial gpsSerial(12, 11); // RX, TX(gps腳位)
int ledpin=15; // l在D13上導致將顯示閃爍開/關ed on D13 will show blink on / off
int BluetoothData; // 計算機給出的數據the data given from Computer

//Variables
int pulsePin = 0;               // 脈衝傳感器紫色線連接到模擬引腳Pulse Sensor purple wire connected to analog pin 0
int blinkPin = 13;                // 引腳在每個節拍處閃爍pin to blink led at each beat
int fadePin = 5;                  // 在每個節拍處做花式優雅的褪色眨眼pin to do fancy classy fading blink at each beat
int fadeRate = 0;               // 用於在fadePin上用PWM淡出LEDused to fade LED on with PWM on fadePin

// Volatile Variables, used in the interrupt service routine!
volatile int BPM;                   // int保持原始的模擬輸入0.每2毫秒更新一次int that holds raw Analog in 0. updated every 2mS
volatile int Signal;                // 保存傳入的原始數據holds the incoming raw data
volatile int IBI = 600;             // int保存節拍之間的時間間隔! 必須種子int that holds the time interval between beats! Must be seeded!
volatile boolean Pulse = false;   // 當用戶的實時心跳被檢測到時為“真”。 “假”不是“現場拍”"True" when User's live heartbeat is detected. "False" when not a "live beat".
volatile boolean QS = false;      // 當Arduoino發現一個節拍成為現實becomes true when Arduoino finds a beat.

// /關心串行輸出 - 設置這符合您的需求Regards Serial OutPut-- Set This Up to your needs
static boolean serialVisual = false;   // 默認設置為“false”。 重新設置為“真”來查看Arduino串行監視器ASCII可視脈衝Set to 'false' by Default.Re-set to 'true' to see Arduino Serial Monitor ASCII Visual Pulse

SoftwareSerial btSerial(10, 9); // RX, TX(藍芽角為)
TinyGPS gps;

void gpsdump(TinyGPS &gps);
void printFloat(double f, int digits = 2);
void setup(){
pinMode(blinkPin,OUTPUT);         // 別針會閃爍你的心跳pin that will blink to your heartbeat!
pinMode(fadePin,OUTPUT);          // 別針會褪色到你的心跳pin that will fade to your heartbeat!
Serial.begin(115200);             // 我們同意快速交談we agree to talk fast!
               // 設置每2mS讀脈衝傳感器信號sets up to read Pulse Sensor signal every 2mS
   // 如果您正在為低電壓脈衝傳感器供電,請聯繫下一行UN-COMMENT THE NEXT LINE IF YOU ARE POWERING The Pulse Sensor AT LOW VOLTAGE,
   // 並將該電壓應用於A-REF引腳AND APPLY THAT VOLTAGE TO THE A-REF PIN
//   analogReference(EXTERNAL);   
btSerial.begin(9600);
btSerial.println("Bluetooth On please press 1 or 0 blink LED ..");
pinMode(ledpin,OUTPUT);
// Oploen串行通信並等待端口打開:Oploen serial communications and wait for port to open:
Serial.begin(9600);
// 設置SoftwareSerial端口的數據速率set the data rate for the SoftwareSerial port
gpsSerial.begin(9600);
btSerial.begin(9600);
delay(1000);
Serial.println("uBlox Neo 6M");
Serial.print("Testing TinyGPS library v. "); Serial.println(TinyGPS::library_version());
Serial.println("by Mikal Hart");
Serial.println();
Serial.print("Sizeof(gpsobject) = ");
Serial.println(sizeof(TinyGPS));
Serial.println();
interruptSetup();

}


//Where the Magic Happens
void loop(){

    serialOutput() ;      
   
if (QS == true){   //心跳被發現A Heartbeat Was Found
                     // BPM和IBI已經確定BPM and IBI have been Determined
                     // 當arduino發現心跳時,量化的自我Quantified Self "QS" true when arduino finds a heartbeat
      digitalWrite(blinkPin,HIGH);   // 閃爍LED,我們得到了一個節拍Blink LED, we got a beat.
      fadeRate = 255;         // 使LED淡化效果發生Makes the LED Fade Effect Happen
                              // 將“fadeRate”變量設置為255,使脈沖淡入Set 'fadeRate' Variable to 255 to fade LED with pulse
      serialOutputWhenBeatHappens();   // 發生一擊,輸出串行A Beat Happened, Output that to serial.   
      QS = false;                      // 重新設置下一次的量化自標記reset the Quantified Self flag for next time   
       }
      else {

      digitalWrite(blinkPin,LOW);            // 沒有拍子,關掉13號LED指示燈There is not beat, turn off pin 13 LED
      }
   
   ledFadeToBeat();                      // 使LED淡化效果發生Makes the LED Fade Effect Happen
if (btSerial.available()){
BluetoothData=btSerial.read();
   if(BluetoothData=='1'){   // if number 1 pressed ....
   digitalWrite(ledpin,1);
   btSerial.println("LEDOn D12 ON ! ");
   }
if (BluetoothData=='0'){// if number 0 pressed ....
digitalWrite(ledpin,0);
   btSerial.println("LEDOn D12 Off ! ");
}
}

delay(2000);//take a break
    bool newdata = true;
unsigned long start = millis();
// Every 5 seconds we print an update
   while (millis() - start < 5000)
{
    if (gpsSerial.available())
   
    {
      char c = gpsSerial.read();
      //Serial.print(c);// 取消註釋查看原始GPS數據uncomment to see raw GPS data
      if (gps.encode(c))
      {
      newdata = true;
      break;// 立即取消打印新數據的註釋!uncomment to print new data immediately!
      }
    }
}
if (newdata)
{
    Serial.println("Acquired Data");
    Serial.println("-------------");
    gpsdump(gps);
    Serial.println("-------------");
    Serial.println();
}
}

小新手 發表於 2017-12-28 19:04:01

void serialOutput(){   // Decide How To Output Serial.
if (serialVisual == true){
   arduinoSerialMonitorVisual('-', Signal);   // 去串行監視器展示台的功能goes to function that makes Serial Monitor Visualizer
} else{
      sendDataToSerial('S', Signal);   // 去sendDataToSerial函數goes to sendDataToSerial function
}      
}


// 決定如何輸出BPM和IBI數據Decides How To OutPut BPM and IBI Data
void serialOutputWhenBeatHappens(){   
if (serialVisual == true){            // 使串行監視器可視化工作的代碼 Code to Make the Serial Monitor Visualizer Work
    Serial.print("*** Heart-Beat Happened *** ");//ASCII藝術瘋狂ASCII Art Madness
    Serial.print("BPM: ");
   btSerial.println("HEART RATE IS");
      btSerial.println(BPM);
    Serial.print(BPM);
    Serial.print("");
} else{
      sendDataToSerial('B',BPM);   // 用“B”前綴發送心率send heart rate with a 'B' prefix
      sendDataToSerial('Q',IBI);   // 用“Q”前綴在節拍之間發送時間send time between beats with a 'Q' prefix
}   
}



//將數據發送到脈衝傳感器處理應用程序,本地Mac應用程序或第三方串行讀取器Sends Data to Pulse Sensor Processing App, Native Mac App, or Third-party Serial Readers.
void sendDataToSerial(char symbol, int data ){
    Serial.print(symbol);

    Serial.println(data);               
}





void ledFadeToBeat(){
    fadeRate -= 15;                         //設置LED淡入值set LED fade value
    fadeRate = constrain(fadeRate,0,255);   //保持LED衰減價值進入負數keep LED fade value from going into negative numbers!
    analogWrite(fadePin,fadeRate);          //淡入LEDfade LED
}


//Code to Make the Serial Monitor Visualizer Work
void arduinoSerialMonitorVisual(char symbol, int data ){   
const int sensorMin = 0;      // 傳感器最小值,通過實驗發現sensor minimum, discovered through experiment
const int sensorMax = 1024;    // 傳感器最大值,通過實驗發現sensor maximum, discovered through experiment

int sensorReading = data;
// 將傳感器範圍映射到12個選項的範圍內map the sensor range to a range of 12 options:
int range = map(sensorReading, sensorMin, sensorMax, 0, 11);

// 做一些不同的取決於do something different depending on the
// 範圍值range value:
switch (range) {
case 0:   
    Serial.println("");   /////ASCII Art Madness
    break;
case 1:   
    Serial.println("---");
    break;
case 2:   
    Serial.println("------");
    break;
case 3:   
    Serial.println("---------");
    break;
case 4:   
    Serial.println("------------");
    break;
case 5:   
    Serial.println("--------------|-");
    break;
case 6:   
    Serial.println("--------------|---");
    break;
case 7:   
    Serial.println("--------------|-------");
    break;
case 8:
    Serial.println("--------------|----------");
    break;
case 9:   
    Serial.println("--------------|----------------");
    break;
case 10:   
    Serial.println("--------------|-------------------");
    break;
case 11:   
    Serial.println("--------------|-----------------------");
    break;

}
}
void printFloat(double number, int digits)
{
// 處理負數Handle negative numbers
if (number < 0.0)
{
   Serial.print('-');
   number = -number;
}

// 圓形正確打印(1.999,2)打印為“2.00”Round correctly so that print(1.999, 2) prints as "2.00"
double rounding = 0.5;
for (uint8_t i=0; i<digits; ++i)
    rounding /= 10.0;

number += rounding;

// 提取數字的整數部分並打印出來Extract the integer part of the number and print it
unsigned long int_part = (unsigned long)number;
double remainder = number - (double)int_part;
Serial.print(int_part);

// 打印小數點,但只有在數字之外Print the decimal point, but only if there are digits beyond
if (digits > 0)
    Serial.print(".");

// 一次提取餘數中的數字Extract digits from the remainder one at a time
while (digits-- > 0)
{
    remainder *= 10.0;
    int toPrint = int(remainder);
    Serial.print(toPrint);
    remainder -= toPrint;
}
}
void gpsdump(TinyGPS &gps)
{
long lat, lon;
float flat, flon;
unsigned long age, date, time, chars;
int year;
byte month, day, hour, minute, second, hundredths;
unsigned short sentences, failed;

gps.get_position(&lat, &lon, &age);
Serial.print("Lat/Long(10^-5 deg): "); Serial.print(lat); Serial.print(", "); Serial.print(lon);
Serial.print(" Fix age: "); Serial.print(age); Serial.println("ms.");

// 在Arduino上,在冗長的Serial.print()中可能會丟失GPS字符On Arduino, GPS characters may be lost during lengthy Serial.print()
// 在Teensy上,串行打印到USB,它具有較大的輸出緩沖和On Teensy, Serial prints to USB, which has large output buffering and
//   運行速度非常快,所以沒必要擔心丟失4800runs very fast, so it's not necessary to worry about missing 4800
//   波特GPS字符。baud GPS characters.

gps.f_get_position(&flat, &flon, &age);
Serial.print("Lat/Long(float): "); printFloat(flat, 5); Serial.print(", "); printFloat(flon, 5);
    Serial.print(" Fix age: "); Serial.print(age); Serial.println("ms.");

gps.get_datetime(&date, &time, &age);
Serial.print("Date(ddmmyy): "); Serial.print(date); Serial.print(" Time(hhmmsscc): ");
    Serial.print(time);
Serial.print(" Fix age: "); Serial.print(age); Serial.println("ms.");

gps.crack_datetime(&year, &month, &day, &hour, &minute, &second, &hundredths, &age);
Serial.print("Date: "); Serial.print(static_cast<int>(month)); Serial.print("/");
    Serial.print(static_cast<int>(day)); Serial.print("/"); Serial.print(year);
Serial.print("Time: "); Serial.print(static_cast<int>(hour+8));Serial.print(":"); //Serial.print("UTC +08:00 Malaysia");
    Serial.print(static_cast<int>(minute)); Serial.print(":"); Serial.print(static_cast<int>(second));
    Serial.print("."); Serial.print(static_cast<int>(hundredths)); Serial.print(" UTC +08:00 Malaysia");
Serial.print("Fix age: ");Serial.print(age); Serial.println("ms.");

Serial.print("Alt(cm): "); Serial.print(gps.altitude()); Serial.print(" Course(10^-2 deg): ");
    Serial.print(gps.course()); Serial.print(" Speed(10^-2 knots): "); Serial.println(gps.speed());
Serial.print("Alt(float): "); printFloat(gps.f_altitude()); Serial.print(" Course(float): ");
    printFloat(gps.f_course()); Serial.println();
Serial.print("Speed(knots): "); printFloat(gps.f_speed_knots()); Serial.print(" (mph): ");
    printFloat(gps.f_speed_mph());
Serial.print(" (mps): "); printFloat(gps.f_speed_mps()); Serial.print(" (kmph): ");
    printFloat(gps.f_speed_kmph()); Serial.println();

gps.stats(&chars, &sentences, &failed);
Serial.print("Stats: characters: "); Serial.print(chars); Serial.print(" sentences: ");
    Serial.print(sentences); Serial.print(" failed checksum: "); Serial.println(failed);
    btSerial.println("Date(ddmmyy): "); btSerial.println(date);
      btSerial.println(" Time(hhmmsscc): ");btSerial.println(time);
}

小新手 發表於 2017-12-28 19:07:11

以上就是合好後有問題的程式....對不起有點長,希望大神們可以幫忙找一下錯誤在哪,現在這樣只能測心跳,GPS沒訊號,改了好久還是找不到問題所在 (用的是UNO或是Leonardo):Q

超新手 發表於 2017-12-28 19:51:01

如果你是用 lenardo,
SoftwareSerial 的 RX 只能是以下接腳之一
8, 9, 10, 11, 14 (MISO), 15 (SCK), 16 (MOSI).
SoftwareSerial gpsSerial(12, 11); // RX, TX(gps腳位)
所以...程式對掉一下
接腳改一下試看看

超新手 發表於 2017-12-28 20:02:37

本帖最後由 超新手 於 2017-12-28 20:19 編輯

另一個限制是
如果使用了兩個以上(含)的 softwareserial
一次只能一個 RX 作用
所以在呼叫 .available() 之前
必須先呼叫 .listen()
這個使用上需要點技巧

建議是把 serial 拿來用
這個是硬體的,限制較少
尤其是 Leonardo ,直接改成 serial1 即可

小新手 發表於 2017-12-28 23:47:43

超新手 發表於 2017-12-28 20:02
另一個限制是
如果使用了兩個以上(含)的 softwareserial
一次只能一個 RX 作用


所以把Serial拿來用的意思是將SoftwareSerial gpsSerial(12, 11); // RX, TX(gps腳位)改為SoftwareSerial Serial1(1, 0); // RX, TX(gps腳位)嗎?
還是說SoftwareSerial gpsSerial(1 0)就行了嗎?(抱歉這樣問,對這個還不很熟悉)
因為晚上了不方便去屋外測試GPS,所以只好先問腳位的問題

超新手 發表於 2017-12-29 05:37:37

本帖最後由 超新手 於 2017-12-29 08:46 編輯

不是
如果你是用 Leonardo
1. 把SoftwareSerial gpsSerial(12, 11);這行拿掉
2. 把所有的 gpsSerial 改成 Serial1
3. 把 gps 接到 0 和 1
如果你是用 UNO
1.不改接腳
2.在 while(millis()-start <5000)加上 listen
gpsSerial.listen();
while(millis()-start <5000) {
.....
}
btSerial.listen();
但是uno 還是建議改用 serial ,然後 gps 接到 0和1
注意!!是 Serial, 和 Leonardo 不同
而且接到 0和1時,下載程式時可能先要拔 gps
否則不能下載

小新手 發表於 2017-12-29 09:12:31

本帖最後由 小新手 於 2017-12-29 09:16 編輯

超新手 發表於 2017-12-29 05:37
不是
如果你是用 Leonardo
1. 把SoftwareSerial gpsSerial(12, 11);這行拿掉


感謝超新手大大的幫助!!! 現在gps和心跳藍芽都能夠正常運行了!! 非常感謝QAQ
頁: [1]
查看完整版本: 想請問兩塊感應器的程式合併問題 (已解決)