[PIC] Jak poprawnie przypisać wartości między tablicami w PIC?

volatile long  polozenie[25];
volatile long  polozenie_zerowe[25]={
                                   0x5240,0x5500,0x5500,0x5240,0x5500,0x5500
                                  ,0x54A0,0x5C00,0x5600,0x2D00,0x6800,0x4A00
                                  ,0x5300,0x6800,0x4A00,0x5500,0x6800,0x4A00
                                  ,0x5400,0x5600,0x5D00,0x5D00};

for (i=1;i<23;i++)
   {
      wyslij(polozenie[i]);
      polozenie[i]=polozenie_zerowe[i-1];    
      wyslij(polozenie[i]);
      wyslij(polozenie_zerowe[i-1]);
      wyslij(i);
      bputc('G');
   }

#include "E:\Robotyka\Projekty\[PIC]\PICC\wizard\wizek.h"

// ++++++ wysylanie +++++++++++
#define T_BUFFER_SIZE 64
byte t_buffer[T_BUFFER_SIZE];
byte t_next_in = 0;
byte t_next_out = 0;

volatile unsigned long  polozenie[25];  
volatile unsigned long  polozenie_zerowe[25]={
                                   0x5240,0x5500,0x5500,0x5240,0x5500,0x5500
                                  ,0x54A0,0x5C00,0x5600,0x2D00,0x6800,0x4A00
                                  ,0x5300,0x6800,0x4A00,0x5500,0x6800,0x4A00
                                  ,0x5400,0x5600,0x5D00,0x5D00};

char                    answer=0,value_8;
long                    timeout,tmp;
int32                   i=0,value_32;

#int_tbe
void t_serial_isr() {
   putc(t_buffer[t_next_out]);
   t_next_out=(t_next_out+1) % T_BUFFER_SIZE;
   if(t_next_in==t_next_out)
     disable_interrupts(int_tbe);
}

void bputc(char c) {
   short restart;
   int ni;

   restart=t_next_in==t_next_out;
   t_buffer[t_next_in]=c;
   ni=(t_next_in+1) % T_BUFFER_SIZE;
   while(ni==t_next_out);
   t_next_in=ni;
   if(restart)
     enable_interrupts(int_tbe);
}

// ++++++ odbieranie +++++++++++
#define BUFFER_SIZE 32
BYTE buffer[BUFFER_SIZE];
BYTE next_in = 0;
BYTE next_out = 0;

#int_rda
void r_serial_isr() {
   int t;

   buffer[next_in]=getc();
   t=next_in;
   next_in=(next_in+1) % BUFFER_SIZE;
   if(next_in==next_out)
     next_in=t;           // Buffer full !!
}

#define bkbhit (next_in!=next_out)

BYTE bgetc() {
   BYTE c;

   while(!bkbhit) ;
   c=buffer[next_out];
   next_out=(next_out+1) % BUFFER_SIZE;
   return(c);
}

// dekoder koncowek nog
short leg(char ktora)
{
   output_d(ktora);
   return input(pin_A1);
}


// wysylanie liczb 16 bit
void wyslij(unsigned  long dana)
{
   bputc((byte)(dana>>8));
   bputc((byte)(dana));
}
// zamiana stopni na liczbe 16bit
unsigned long zamien(long dana, char ktore)    
{
 	return polozenie_zerowe[ktore]+(dana-90)*167;
}


void main(void)
{

   setup_adc_ports(AN0|VREF_VREF);
   setup_adc(ADC_CLOCK_INTERNAL|ADC_TAD_MUL_0);
   setup_psp(PSP_DISABLED);
   setup_spi(FALSE);
   setup_wdt(WDT_OFF);
   setup_timer_0(RTCC_INTERNAL);
   setup_timer_1(T1_DISABLED);
   setup_timer_2(T2_DIV_BY_1,110,1);
   setup_timer_3(T3_DISABLED|T3_DIV_BY_1);
   setup_comparator(NC_NC_NC_NC);
   setup_vref(FALSE);
   setup_oscillator(False);

   setup_ccp1(CCP_PWM);
   set_pwm1_duty(55);

   enable_interrupts(global);
   enable_interrupts(int_rda);

   output_d(0x01);
   set_adc_channel(0);

   
// Handshake
   do
   {
      bputc('H');

      timeout=0;
      while(!bkbhit&&(++timeout<50000))
      delay_us(10);
      if(bkbhit)
      answer=bgetc();

   }while(answer!='F');

// wyslanie wartosci poczatkowych serw
   for (i=1;i<23;i++)
   {
      
      tmp=polozenie_zerowe[i-1];
      polozenie[i]=tmp;    
      
   }
   
   for(i=1;i<23;i++)
   {
      wyslij(polozenie[i]);  
   
   }


   setup_adc_ports(AN0|VSS_VDD);
   while(1)
   {
/*
      value_32 = Read_ADC();
      printf("%ld \n\r", value_32);
      for(i=0;i<100;i++) delay_ms(10);
*/
  
   }


}