FESB-Racing-AG/tempSensorCan.cpp at main · Grgur00/FESB-Racing-AG · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
#include "mcp_can.h"
#include "thermistor.h"
#include "HardwareSerial.h"

MCP_CAN CAN0(53);
#define NUM_THERMISTORS 10

// Analog pin used to read the NTC
#define NTC_PIN0               A2
#define NTC_PIN1               A3
#define NTC_PIN2               A4
#define NTC_PIN3               A5
#define NTC_PIN4               A6
#define NTC_PIN5               A7
#define NTC_PIN6               A8
#define NTC_PIN7               A9
#define NTC_PIN8               A10
#define NTC_PIN9               A11


int pins[] = {NTC_PIN0, NTC_PIN1, NTC_PIN2, NTC_PIN3, NTC_PIN4, NTC_PIN5, NTC_PIN6, NTC_PIN7, NTC_PIN8, NTC_PIN9};


// THERMISTOR object

//ne postoji default constructor zato su ovako a ne odma u array

THERMISTOR thermistor0(NTC_PIN0,        // Analog pin
                      10000,          // Nominal resistance at 25 ºC
                      3950,           // thermistor's beta coefficient
                      10000);         // Value of the series resistor

THERMISTOR thermistor1(NTC_PIN1,        // Analog pin
                      10000,          // Nominal resistance at 25 ºC
                      3950,           // thermistor's beta coefficient
                      10000);         // Value of the series resistor

THERMISTOR thermistor2(NTC_PIN2,        // Analog pin
                      10000,          // Nominal resistance at 25 ºC
                      3950,           // thermistor's beta coefficient
                      10000);         // Value of the series resistor

THERMISTOR thermistor3(NTC_PIN3,        // Analog pin
                      10000,          // Nominal resistance at 25 ºC
                      3950,           // thermistor's beta coefficient
                      10000);         // Value of the series resistor

THERMISTOR thermistor4(NTC_PIN4,        // Analog pin
                      10000,          // Nominal resistance at 25 ºC
                      3950,           // thermistor's beta coefficient
                      10000);         // Value of the series resistor

THERMISTOR thermistor5(NTC_PIN5,        // Analog pin
                      10000,          // Nominal resistance at 25 ºC
                      3950,           // thermistor's beta coefficient
                      10000);         // Value of the series resistor

THERMISTOR thermistor6(NTC_PIN6,        // Analog pin
                      10000,          // Nominal resistance at 25 ºC
                      3950,           // thermistor's beta coefficient
                      10000);         // Value of the series resistor

THERMISTOR thermistor7(NTC_PIN7,        // Analog pin
                      10000,          // Nominal resistance at 25 ºC
                      3950,           // thermistor's beta coefficient
                      10000);         // Value of the series resistor

THERMISTOR thermistor8(NTC_PIN8,        // Analog pin
                      10000,          // Nominal resistance at 25 ºC
                      3950,           // thermistor's beta coefficient
                      10000);         // Value of the series resistor

THERMISTOR thermistor9(NTC_PIN9,        // Analog pin
                      10000,          // Nominal resistance at 25 ºC
                      3950,           // thermistor's beta coefficient
                      10000);         // Value of the series resistor

THERMISTOR thermistors[] = {thermistor0, thermistor1, thermistor2, thermistor3, thermistor4, thermistor5, thermistor6, thermistor7, thermistor8, thermistor9};

// Global temperature reading
uint8_t temps = NULL;


void setup()
{
  Serial.begin(9600);
  if( CAN0.begin(MCP_ANY, CAN_500KBPS, MCP_8MHZ) == CAN_OK)
    Serial.println("Initialized");

  else
    Serial.println("Error initializing");

  CAN0.setMode(MCP_NORMAL);

}

void loop()
{

  float temperatures[NUM_THERMISTORS];
  for (int i = 0; i < NUM_THERMISTORS; i++) {
    temperatures[i] = thermistors[i].read();
    Serial.print("THERMISTOR ");
    Serial.print(i);
    Serial.print(": ");
    Serial.println(temperatures[i]);
  }

  uint8_t data[4];
  for (int i = 0; i < NUM_THERMISTORS; i++) {
    int16_t temp_data = (int16_t)(temperatures[i] * 10);
    data[i * 2] = temp_data & 0xff;
    data[i * 2 + 1] = (temp_data >> 8) & 0xff;
  }

  CAN0.sendMsgBuf(0x100, 0, NUM_THERMISTORS * 2, data);

  delay(2000); //library je napravljen tako da svako ocitavanje jednog termistora traje 100ms  pa delay ne moze bit manji od 1000 za 10 termistora
}