FESB-Racing-AG/TempSensorV2.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
121
122
123
124
125
126
127
128
129
130
#include "mcp_can.h"
#include "thermistor.h"
#include "HardwareSerial.h"
#include "SPI.h"

MCP_CAN CAN0(53);
// #define NUM_THERMISTORS 10
#define NUM_THERMISTORS 1
// 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};

THERMISTOR thermistors[] = {thermistor4};

// Global temperature reading
uint8_t temps = NULL;

uint8_t convertTemp(float *tempArray){

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

  }

  return *data;
}


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

  else
    Serial.println("Error initializing");


}

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]);
  }

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

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