Poniżej kod "przetłumaczony" na C, sprawdziłem tylko na szybko symulację w AS.
[syntax=c]//wiem, że tak sie nie robi,ale Arduino ma kwarc 16MHz
// i tu wyjatkowo dla podkreślenia, że kod jest dla
//takiej własnie częstotliwości
#define F_CPU 16000000L
//arduino ma na pkładzie atmegę 168
#include <avr/io.h>
#include <util/delay.h>
#include <avr/interrupt.h>
//this programm will put out a PPM signal
//////////////////////CONFIGURATION///////////////////////////////
#define chanel_number 8 //set the number of chanels
#define default_servo_value 1500 //set the default servo value
#define PPM_FrLen 22500 //set the PPM frame length in microseconds (1ms = 1000µs)
#define PPM_PulseLen 300 //set the pulse length
#define onState 1 //set polarity of the pulses: 1 is positive, 0 is negative
#define sigPin 10 //set PPM signal output pin on the arduino
#define true 1
#define faalse 0
//////////////////////////////////////////////////////////////////
/*this array holds the servo values for the ppm signal
change theese values in your code (usually servo values move between 1000 and 2000)*/
int ppm[chanel_number];
void setup(){
//initiallize default ppm values
for(int i=0; i<chanel_number; i++){
ppm[i]= default_servo_value;
}
//pinMode(sigPin, OUTPUT);
DDRB |= (1 << PB2);
//digitalWrite(sigPin, !onState); //set the PPM signal pin to the default state (off)
PORTB &= ~ (1<<PB2);
cli();
TCCR1A = 0; // set entire TCCR1 register to 0
TCCR1B = 0;
OCR1A = 100; // compare match register, change this
TCCR1B |= (1 << WGM12); // turn on CTC mode
TCCR1B |= (1 << CS11); // 8 prescaler: 0,5 microseconds at 16mhz
TIMSK1 |= (1 << OCIE1A); // enable timer compare interrupt
sei();
}
void loop(){
//put main code here
static int val = 1;
ppm[0] = ppm[0] + val;
if(ppm[0] >= 2000){ val = -1; }
if(ppm[0] <= 1000){ val = 1; }
_delay_ms(10);
}
ISR(TIMER1_COMPA_vect)
{ //leave this alone
//static boolean state = true; //nie ma typu bolean
static uint8_t state=true;
TCNT1 = 0;
if(state) { //start pulse
//digitalWrite(sigPin, onState);
PORTB |= (1<<PB2);
OCR1A = PPM_PulseLen * 2;
state = 0;//false;
}
else{ //end pulse and calculate when to start the next pulse
static uint8_t cur_chan_numb;//startc byte cur_chan_numb;
static unsigned int calc_rest;
//digitalWrite(sigPin, !onState);
PORTB &= ~ (1<<PB2);
state = true;
if(cur_chan_numb >= chanel_number){
cur_chan_numb = 0;
calc_rest = calc_rest + PPM_PulseLen;//
OCR1A = (PPM_FrLen - calc_rest) * 2;
calc_rest = 0;
}
else{
OCR1A = (ppm[cur_chan_numb] - PPM_PulseLen) * 2;
calc_rest = calc_rest + ppm[cur_chan_numb];
cur_chan_numb++;
}
}
}
int function(void)
{
setup();
while(1){loop();};
}[/syntax]Statystyki: Napisane przez nemo — 9 wrz 2016, o 21:27
]]>
