-
Notifications
You must be signed in to change notification settings - Fork 1
/
resistencia.c
101 lines (85 loc) · 1.65 KB
/
resistencia.c
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
#include <avr/io.h>
#include <util/delay.h>
#include "resistencia.h"
#include "adc.h"
#include "lcd_3_wire.h"
#define BIT_SET(r,b) ((r)|=(1<<(b)))
#define BIT_CLEAR(r,b) ((r)&=~(1<<(b)))
// macros per fer el codi llegible
#define OUTPUT_H(a) BIT_SET(a ## _DDR, (a)); \
BIT_SET(a ## _PORT, (a))
#define OUTPUT_Z(a) BIT_CLEAR(a ## _DDR, (a)); \
BIT_CLEAR(a ## _PORT, (a))
//
#define VAL 700
#define R_TOP 1000
// variables
uint8_t i;
extern char string[16];
// funcions
uint32_t formula_r ( uint16_t adcval, uint8_t mult )
{
uint32_t multiplicador = 1;
uint8_t j;
for (j=1; j<mult; j++)
{
multiplicador *= 10; // multipliquem per 10 el valor
}
return (multiplicador)*(((uint32_t)adcval*560)/(1024-adcval));
}
void r_init(void)
{
// pins a alta impedancia
OUTPUT_Z(RM1);
OUTPUT_Z(RM2);
OUTPUT_Z(RM3);
OUTPUT_Z(RM4);
OUTPUT_Z(RVIN);
}
uint8_t calcula_r (struct res *r)
{
uint16_t adcval=0;
// pins a alta impedancia
r_init();
// mirem vin amb r1 a vcc
OUTPUT_H(RM1);
_delay_ms(100);
adcval = ReadAdc(RVIN);
OUTPUT_Z(RM1);
if (adcval <= VAL)
{
r->valor = formula_r(adcval, 1);
return 1;
}
// mirem vin amb r2 a vcc
OUTPUT_H(RM2);
_delay_ms(100);
adcval = ReadAdc(RVIN);
OUTPUT_Z(RM2);
if (adcval <= VAL)
{
r->valor = formula_r(adcval, 2);
return 2;
}
// mirem vin amb r3 a vcc
OUTPUT_H(RM3);
_delay_ms(100);
adcval = ReadAdc(RVIN);
OUTPUT_Z(RM3);
if (adcval <= VAL)
{
r->valor = formula_r(adcval, 3);
return 3;
}
// mirem vin amb r4 a vcc
OUTPUT_H(RM4);
_delay_ms(100);
adcval = ReadAdc(RVIN);
OUTPUT_Z(RM4);
if ( adcval < VAL )
{
r->valor = formula_r(adcval, 4);
return 4;
}
return 10;
}