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
|
#include <Arduino.h>
#include <TimerOne.h>
void analogWriteSAH_Init(void)
{
// Stop the timer while we muck with it
TCCR1B = (0 << ICNC1) | (0 << ICES1) | (0 << WGM13) | (0 << WGM12) | (0 << CS12) | (0 << CS11) | (0 << CS10);
// Set the timer to mode 14...
//
// Mode WGM13 WGM12 WGM11 WGM10 Timer/Counter Mode of Operation TOP Update of OCR1x at TOV1 Flag Set on
// CTC1 PWM11 PWM10
// ---- ----- ----- ----- ----- ------------------------------- ---- ----------------------- -----------
// 14 1 1 1 0 Fast PWM ICR1 BOTTOM TOP
// Set output on Channel A to...
//
// COM1A1 COM1A0 Description
// ------ ------ -----------------------------------------------------------
// 1 0 Clear OC1A/OC1B on Compare Match (Set output to low level).
TCCR1A =
(1 << COM1A1) | (0 << COM1A0) | // COM1A1, COM1A0 = 1, 0
(0 << COM1B1) | (0 << COM1B0) |
(1 << WGM11) | (0 << WGM10); // WGM11, WGM10 = 1, 0
// Set TOP to...
//
// fclk_I/O = 16000000
// N = 1
// TOP = 799
//
// fOCnxPWM = fclk_I/O / (N * (1 + TOP))
// fOCnxPWM = 16000000 / (1 * (1 + 799))
// fOCnxPWM = 16000000 / 800
// fOCnxPWM = 20000
ICR1 = 799;
// Ensure the first slope is complete
TCNT1 = 0;
// Ensure Channel B is irrelevant
OCR1B = 0;
// Ensure Channel A starts at zero / off
OCR1A = 0;
// We don't need no stinkin interrupts
TIMSK1 = (0 << ICIE1) | (0 << OCIE1B) | (0 << OCIE1A) | (0 << TOIE1);
// Ensure the Channel A pin is configured for output
DDRB |= (1 << DDB1);
// Start the timer...
//
// CS12 CS11 CS10 Description
// ---- ---- ---- ------------------------
// 0 0 1 clkI/O/1 (No prescaling)
TCCR1B =
(0 << ICNC1) | (0 << ICES1) |
(1 << WGM13) | (1 << WGM12) | // WGM13, WGM12 = 1, 1
(0 << CS12) | (0 << CS11) | (1 << CS10);
}
void analogWriteD9(uint16_t value)
{
if ((value >= 0) && (value < 800))
{
OCR1A = value;
}
}
void setup()
{
//analogWriteSAH_Init();
Timer1.initialize(50);
Timer1.pwm(9, 1024/2);
Serial.begin(9600);
}
void loop()
{
static int old_poti = 0;
int poti = analogRead(A7) / 10;
if (poti != old_poti) {
// period_us = 1 / khz * 1000
int period_us = (poti == 0) ? 0 : map(poti, 1, 102, 600, 50);
Timer1.initialize(period_us);
Timer1.pwm(9, 1024/2);
Serial.println(poti);
Serial.println(period_us);
old_poti = poti;
}
//Timer1.setPeriod();
//Timer1.setPeriod(50);
//Timer1.restart();
#if 0
for (float frequency = 500; frequency < 3000; frequency = frequency + 1) {
float T = 1 / frequency * 1000000;
//Timer1.setPeriod(T);
delay(5);
}
#endif
}
|
