#define F_CPU 16000000UL //Set processor speed 16 Mhz
#include <avr/io.h>
#include <avr/interrupt.h>
#include <util/delay.h>
#include <dynamixel.h>
void moveservo();
int i;
int main(void)
{
DDRC = 0xFF; //Set all PORT C as output
PORTC = 0xFE; //Turn on D1 LED
cli(); //Disable global interrupts
TCCR1A = 0; //set entire TCCR1A to 0
TCCR1B = 0; //set entire TCCR1B to 0
OCR1A = 15624; // set compare match register to desired timer count
TCCR1B |= (1 << WGM12); // turn on CTC mode:
TCCR1B |= (1 << CS10); // Set CS10 and CS12 bits for 1024 prescaler:
TCCR1B |= (1 << CS12);
TIMSK1 |= (1 << OCIE1A);// enable timer compare interrupt:
sei(); // enable global interrupts
dxl_initialize(0,1); //0= number connected com devices, 1= Baud rate
serial_initialize(57600);
while(1)
{
int x = 2;
if (x > 3)
}
return 1;
}
ISR(TIMER1_COMPA_vect)
{
static int j=0, i=0;
j++;
if (j>=64) {
j=0;
//PORTC = ~(1<<i);
i++;
if (i > 4) i=0;
int goal_pos = 160*i;
int mot_num = 18;
int address = 30;
//int pos = dxl_read_word(18,36);
dxl_write_word(254,address,goal_pos);
}
}
I2RlZmluZSBGX0NQVSAxNjAwMDAwMFVMIC8vU2V0IHByb2Nlc3NvciBzcGVlZCAxNiBNaHoKI2luY2x1ZGUgPGF2ci9pby5oPgojaW5jbHVkZSA8YXZyL2ludGVycnVwdC5oPgojaW5jbHVkZSA8dXRpbC9kZWxheS5oPgojaW5jbHVkZSA8ZHluYW1peGVsLmg+Cgp2b2lkIG1vdmVzZXJ2bygpOwoKaW50IGk7CgppbnQgbWFpbih2b2lkKQp7CglERFJDID0gMHhGRjsgLy9TZXQgYWxsIFBPUlQgQyBhcyBvdXRwdXQKCVBPUlRDID0gMHhGRTsgLy9UdXJuIG9uIEQxIExFRAoJY2xpKCk7IC8vRGlzYWJsZSBnbG9iYWwgaW50ZXJydXB0cwoJVENDUjFBID0gMDsgLy9zZXQgZW50aXJlIFRDQ1IxQSB0byAwCglUQ0NSMUIgPSAwOyAvL3NldCBlbnRpcmUgVENDUjFCIHRvIDAKCU9DUjFBID0gMTU2MjQ7IC8vIHNldCBjb21wYXJlIG1hdGNoIHJlZ2lzdGVyIHRvIGRlc2lyZWQgdGltZXIgY291bnQKCVRDQ1IxQiB8PSAoMSA8PCBXR00xMik7IC8vIHR1cm4gb24gQ1RDIG1vZGU6CglUQ0NSMUIgfD0gKDEgPDwgQ1MxMCk7IC8vIFNldCBDUzEwIGFuZCBDUzEyIGJpdHMgZm9yIDEwMjQgcHJlc2NhbGVyOgoJVENDUjFCIHw9ICgxIDw8IENTMTIpOwoJVElNU0sxIHw9ICgxIDw8IE9DSUUxQSk7Ly8gZW5hYmxlIHRpbWVyIGNvbXBhcmUgaW50ZXJydXB0OgoJCgkKCQoJc2VpKCk7IC8vIGVuYWJsZSBnbG9iYWwgaW50ZXJydXB0cwoJCglkeGxfaW5pdGlhbGl6ZSgwLDEpOyAvLzA9IG51bWJlciBjb25uZWN0ZWQgY29tIGRldmljZXMsIDE9IEJhdWQgcmF0ZSAKCXNlcmlhbF9pbml0aWFsaXplKDU3NjAwKTsKCgkKCXdoaWxlKDEpCgl7CgkJaW50IHggPSAyOwoJCWlmICh4ID4gMykgCgkJCXByaW50ZigidGVzdCIpOwoKCX0KCXJldHVybiAxOwp9CgoKSVNSKFRJTUVSMV9DT01QQV92ZWN0KQp7CglzdGF0aWMgaW50IGo9MCwgaT0wOwoJaisrOwoJaWYgKGo+PTY0KSB7CgkJaj0wOwoJCS8vUE9SVEMgPSB+KDE8PGkpOwoJCWkrKzsKCQlpZiAoaSA+IDQpIGk9MDsKCQlpbnQgZ29hbF9wb3MgPSAxNjAqaTsKCQlpbnQgbW90X251bSA9IDE4OwoJCWludCBhZGRyZXNzID0gMzA7CgkJLy9pbnQgcG9zID0gZHhsX3JlYWRfd29yZCgxOCwzNik7CgkJZHhsX3dyaXRlX3dvcmQoMjU0LGFkZHJlc3MsZ29hbF9wb3MpOwoJfQp9Cg==