Control de Servomotores con SDCC- Original de RedPIC Parte 1

Control de 8 servos de RC por puerto serie -- Original de RedPIC traducido a SDCC

Mensaje maigke el Vie 17 Sep 2010 - 9:32
Buenas noches a todos (Aquí en Mx es de madrugada)

Bien en esta ocasion les presento un codigo que es original de RedPIc, y que gracias a la lógica que el presenta en su sitio, he aprendido bastante. Pues bien, aqui esta el código que el nos presenta para controlar 8 servomotores con una sola interrupcion del timer1 a 16 bits, pero con las siguientes modificaciones:

-- El pic es un 18F2550
-- El lenguaje claro que es SDCC y pues así lo hace libre esto.
-- El oscilador es a 20MHz, pero basado en el proyecto Pinguino se establece que el micro trabaje a 12MIPS.
-- Tome algunos ejemplos de como trabaja el proyecto Pinguino de Jean - Pierre Mandon.
-- Aun el micro no entiende lo que le mandes por el puerto paralelo serial (andaba medio dormido). cyclops pero ya mero

sin mas preambulos, les muestro el código, que digamoslo así, es casí una copia fiel, pero con sus bueno retoques, algo importante, no se la causa del por que el SDCC no trabaja bien con las operaciones de 16bits, así que tuve que hacer algunos ajustes, así que tuve que gastar aun mas recursos de los que ya de por si SDCC requiere. posterior les presento algunas pantallas.

Espero sus notas y comentarios:, por cierto este post, se puede ligar al de GAMBAS + pic16f628 + puerto serial. Wink


/* ----------------------------------------------------------------------- */

/* Plantilla generada por Piklab */

/*

La configuracion del micro nos permite trabajar un con XT de 20MHZ

y pero usar el PLL con el propósito de alcanzar los 12MIPS

*/

#include <pic18f2550.h>

#include <delay.h>

#include <uart18f2550.c>

/* ----------------------------------------------------------------------- */

/* Bits de configuración: adapte los parámetros a su necesidad */

code char at __CONFIG1L CONFIG1L = _PLLDIV_DIVIDE_BY_5__20MHZ_INPUT__1L & _CPUDIV__OSC1_OSC2_SRC___1__96MHZ_PLL_SRC___2__1L & _USBPLL_CLOCK_SRC_FROM_96MHZ_PLL_2_1L;

code char at __CONFIG1H CONFIG1H = _OSC_HS__HS_PLL__USB_HS_1H & _FCMEN_ON_1H & _IESO_ON_1H;

code char at __CONFIG2L CONFIG2L = _PUT_ON_2L & _BODEN_ON_2L & _BODENV_4_2V_2L & _VREGEN_ON_2L;

code char at __CONFIG2H CONFIG2H = _WDT_DISABLED_CONTROLLED_2H & _WDTPS_1_32768_2H;

code char at __CONFIG3H CONFIG3H = _CCP2MUX_RC1_3H & _PBADEN_PORTB_4_0__CONFIGURED_AS_DIGITAL_I_O_ON_RESET_3H & _LPT1OSC_ON_3H & _MCLRE_MCLR_OFF_RE3_ON_3H;

code char at __CONFIG4L CONFIG4L = _STVR_ON_4L & _LVP_OFF_4L & _ENHCPU_OFF_4L & _BACKBUG_OFF_4L;

code char at __CONFIG5L CONFIG5L = _CP_0_OFF_5L & _CP_1_OFF_5L & _CP_2_OFF_5L & _CP_3_OFF_5L;

code char at __CONFIG5H CONFIG5H = _CPB_OFF_5H;

code char at __CONFIG6L CONFIG6L = _WRT_0_OFF_6L & _WRT_1_OFF_6L & _WRT_2_OFF_6L & _WRT_3_OFF_6L;

code char at __CONFIG6H CONFIG6H = _WRTC_OFF_6H & _WRTB_OFF_6H;

code char at __CONFIG7L CONFIG7L = _EBTR_0_OFF_7L & _EBTR_1_OFF_7L & _EBTR_2_OFF_7L & _EBTR_3_OFF_7L;

code char at __CONFIG7H CONFIG7H = _EBTRB_OFF_7H;



//Definiciones de servos

#define SERVO1 LATBbits.LATB0

#define SERVO2 LATBbits.LATB1

#define SERVO3 LATBbits.LATB2

#define SERVO4 LATBbits.LATB3

#define SERVO5 LATBbits.LATB4

#define SERVO6 LATBbits.LATB5

#define SERVO7 LATBbits.LATB6

#define SERVO8 LATBbits.LATB7



#define CSERVO1 TRISBbits.TRISB0

#define CSERVO2 TRISBbits.TRISB1

#define CSERVO3 TRISBbits.TRISB2

#define CSERVO4 TRISBbits.TRISB3

#define CSERVO5 TRISBbits.TRISB4

#define CSERVO6 TRISBbits.TRISB5

#define CSERVO7 TRISBbits.TRISB6

#define CSERVO8 TRISBbits.TRISB7



typedef enum{false = 0, true = 1} boolean;



//Constantes para la definición de ventanas

const unsigned Ticks4WindowH = 0x75;

const unsigned Ticks4WindowL = 0x2F;

const unsigned Ticks4CenterH = 0x46;

const unsigned Ticks4CenterL = 0x4F;

const unsigned Ticks4MinimumH = 0x17;

const unsigned Ticks4MinimumL = 0x6F;

const unsigned Ticks4MaximumH = 0x6B;

const unsigned Ticks4MaximumL = 0xCF;

static unsigned int Ticks4NextInterruptH = 0xCF;

static unsigned int Ticks4NextInterruptL = 0x2C;



static unsigned short Servo_PWMH[8];

static unsigned short Servo_PWML[8];

static unsigned short Servo_Idx = 0;



#define SERVO1_ON true

#define SERVO2_ON false

#define SERVO3_ON false

#define SERVO4_ON false

#define SERVO5_ON false

#define SERVO6_ON false

#define SERVO7_ON false

#define SERVO8_ON false



//definicion de teclas

#define INTRO 0x0D

#define RETROCESO 0x08

#define ESCAPE 0x1B



unsigned short flag_Phase;

unsigned short j=0xFF;



/*Seccion para la comunicacion en serial*/



#define  lenbuff 10



unsigned char xbuff=0x00;

unsigned char cbuff[lenbuff];

char rcvchar=0x00;

unsigned char flagcommand = 0;





//Prototipos

void init_board(void);

void EnableTimer1Interrupt();

void Tmr1Carga(unsigned char high, unsigned char low);

void delay_ms(int milis);

void delay_us(int milis);





//Sección de interrupciones



static void isr_Tmr1() interrupt 1    //Esta es una interrupcion de alta prioridad

{

   PIE1bits.RCIE=0;  //deshabilitamos la interrupcion del puerto serie

   if(flag_Phase == 1)

   {

      if(Servo_Idx == 0 && SERVO1_ON) {SERVO1 = 1;}

      if(Servo_Idx == 1 && SERVO2_ON) {SERVO2 = 1;}

      if(Servo_Idx == 2 && SERVO3_ON) {SERVO3 = 1;}

      if(Servo_Idx == 3 && SERVO4_ON) {SERVO4 = 1;}

      if(Servo_Idx == 4 && SERVO5_ON) {SERVO5 = 1;}

      if(Servo_Idx == 5 && SERVO6_ON) {SERVO6 = 1;}

      if(Servo_Idx == 6 && SERVO7_ON) {SERVO7 = 1;}

      if(Servo_Idx == 7 && SERVO8_ON) {SERVO8 = 1;}

      Ticks4NextInterruptH = 0xFF - Servo_PWMH[Servo_Idx];

      Ticks4NextInterruptL = 0xFF - Servo_PWML[Servo_Idx];

      Tmr1Carga(Ticks4NextInterruptH,Ticks4NextInterruptL);

   }

  

   if(flag_Phase == 0)

   {

      if(Servo_Idx == 0 && SERVO1_ON) {SERVO1 = 0;}

      if(Servo_Idx == 1 && SERVO2_ON) {SERVO2 = 0;}

      if(Servo_Idx == 2 && SERVO3_ON) {SERVO3 = 0;}

      if(Servo_Idx == 3 && SERVO4_ON) {SERVO4 = 0;}

      if(Servo_Idx == 4 && SERVO5_ON) {SERVO5 = 0;}

      if(Servo_Idx == 5 && SERVO6_ON) {SERVO6 = 0;}

      if(Servo_Idx == 6 && SERVO7_ON) {SERVO7 = 0;}

      if(Servo_Idx == 7 && SERVO8_ON) {SERVO8 = 0;}

      Ticks4NextInterruptH = 0xFF - Ticks4WindowH;

      Ticks4NextInterruptL = 0xFF - Ticks4WindowL;

      

      if(Ticks4NextInterruptL + Servo_PWML[Servo_Idx] > 0xFF)

      {

         Ticks4NextInterruptL = Ticks4NextInterruptL + Servo_PWML[Servo_Idx];

         Ticks4NextInterruptH = Ticks4NextInterruptH + Servo_PWMH[Servo_Idx] + 1;

      }

      else

      {

         Ticks4NextInterruptL = Ticks4NextInterruptL + Servo_PWML[Servo_Idx];

         Ticks4NextInterruptH = Ticks4NextInterruptH + Servo_PWMH[Servo_Idx];

      }

      Tmr1Carga(Ticks4NextInterruptH,Ticks4NextInterruptL);

      if(++Servo_Idx > 7 ) Servo_Idx = 0;

   }

   if(++flag_Phase > 1) flag_Phase = 0;

   //Esta instruccion se esta ejecutando cada 13ms con un xtal de 20MHz  

    LATBbits.LATB7^=1; //complementamos el valor del bit RB7

//   RB7^=1;  <- dice que no se puede así

    PIR1bits.TMR1IF=0; //limpiamos la bandera de interrupcion

    PIE1bits.RCIE=1;  //habilitamos la interrupcion del puerto serie

    //Carga el timer para 1ms

    //Tmr1Carga(0xD1,0x1F);    //TMR1 = FFFF - FF00

}





static void isr_Serial() interrupt 2  //Esta es una interrupcion de baja prioridad

{

   PIR1bits.RCIF=0;

   rcvchar=RCREG;

   Printf(rcvchar);

}



//Funcion Principal

void main() {

//declaracion de variables

int i=0;

int button_down=1;

int valTimer=0;



RCONbits.IPEN=1; //interrupciones por prioridad habilitadas



init_board();

Print_str("Dispositivo inicializado");

Printf(INTRO);

Print_str("PIC18F2550 en SDCC");

Printf(INTRO);





for (i=0;i<9;i++)

{

   Servo_PWMH[i] = Ticks4MaximumH;

   Servo_PWML[i] = Ticks4MaximumL;

}

EnableTimer1Interrupt();

while (true)

{

}

}



void init_board(void) {

ADCON1=0x7; // PORTA used for digital I/O

TRISAbits.TRISA4=true; // configure PORTA4 for input (pushbutton)



/* Configuramos las salidas de los servomotores*/

CSERVO1 = false;

CSERVO2 = false;

CSERVO3 = false;

CSERVO4 = false;

CSERVO5 = false;

CSERVO6 = false;

CSERVO7 = false;

CSERVO8 = false;



//Configuramos la comunicacion serial --rutina de jean Pierre Mandon

setup_UART(B57600);

}



void EnableTimer1Interrupt()

{

   TMR1H=0xFF;

   TMR1L=0x00;    //TMR1 = FFFF - FF00

   T1CON=1;        //Timer1 preescaler 1 interno, carga de 8 bits

   PIE1bits.TMR1IE=1;

   INTCONbits.PEIE=1;

   INTCONbits.GIE=1;

}



void Tmr1Carga(unsigned char high, unsigned char low)

{

   TMR1H=high;

   TMR1L=low;

}

      

void delay_ms(int milis){

delay1ktcy(5*milis);

}



void delay_us(int milis){

delay10tcy(1*milis);

}


Y esta es la rutina de comunicacion serial de Jean Pierre que use

// UART Library for PIC 18F2550
// SDCC version / small device c compiler
// written by Jean-Pierre MANDON 2008 jp.mandon@free.fr
// www.pictec.org
/*
This program is free software; you can redistribute it and/or modify it
under the terms of the GNU General Public License as published by the
Free Software Foundation; either version 2, or (at your option) any
later version.

This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.

You should have received a copy of the GNU General Public License
along with this program; if not, write to the Free Software
Foundation, 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.

In other words, you are welcome to use, share and improve this program.
You are forbidden to forbid anyone else to use, share and improve
what you give them. Help stamp out software-hoarding!
*/
// this program is intended for an oscillator frequency of 20 Mhz


// SPBRG value for FOSC 20 Mhz

#define B300 1,0,0x27,0x0F
#define B1200 1,0,0x09,0xC3
#define B2400 1,0,0x04,0xE1
#define B4800 1,0,0x02,0x70
#define B9600 0,0,0x00,0x4D
#define B19200 0,0,0x00,0x26
#define B57600 1,1,0x00,0xCF
#define B115200 1,1,0x00,0x67

// local definition UART.C

#define BUFFER 128 // rx buffer length
char rx[BUFFER]; // this is the buffer
unsigned char wpointer,rpointer; // write and read pointer

#define charreceived (wpointer!=rpointer)
#define SERIAL

typedef struct
{
unsigned int
hhigh4:4,
hlow4:4,
lhigh4:4,
llow4:4;
} bitfield;

// setup PIC UART

void setup_UART(unsigned char brg16,unsigned char brgh,unsigned char highbyte,unsigned char lowbyte)
{
TXSTAbits.BRGH=brgh&1; // set BRGH bit
BAUDCONbits.BRG16=brg16&1; // set 16 bits SPBRG
SPBRGH=highbyte; // set UART speed SPBRGH
SPBRG=lowbyte; // set UART speed SPBRGL
RCSTA=0x90; // set RCEN and SPEN
BAUDCONbits.RCIDL=1; // set receive active
PIE1bits.RCIE=1; // enable interrupt on RX
INTCONbits.PEIE=1; // enable peripheral interrupts
IPR1bits.RCIP=0; // define low priority for RX interrupt
wpointer=1; // initialize write pointer
rpointer=1; // initialize read pointer
TXSTAbits.TXEN=1; // enable TX
INTCONbits.GIE=1;
}

// UART write char

void Printf(unsigned char caractere)
{
while (!TXSTAbits.TRMT);
TXREG=caractere; // yes, send char
}

// rxint is called by interruption service routine

void rxint(void)
{
char caractere;
unsigned char newwp;

PIR1bits.RCIF=0; // clear RX interrupt flag
caractere=RCREG; // take received char
if (wpointer!=BUFFER-1) // if not last place in buffer
newwp=wpointer+1; // place=place+1
else
newwp=1; // else place=1

if (rpointer!=newwp) // if read pointer!=write pointer
rx[wpointer++]=caractere; // store received char

if (wpointer==BUFFER) // if write pointer=length buffer
wpointer=1; // write pointer = 1
}


// get char

unsigned char getch()
{
unsigned char caractere=0;

if (charreceived)
{
caractere=rx[rpointer++];
if (rpointer==BUFFER)
rpointer=1;
}
return(caractere);
}

// clear rx buffer

void clear_buffer(void) {
wpointer=1;
rpointer=1;
}

// write a string on the UART

void Print_str(const char* text)
{
unsigned char i=0;
while ( text[i] != 0 )
Printf( text[i++] );
}

// convert 16 bits binary value to DEC and send it on the UART

void Print_dec(unsigned int valeur)
{
unsigned char result;
unsigned char zero=1;


result=valeur/10000;
if (result!=0) {
Printf(result+0x30);
zero=0;
}
valeur=valeur%10000;
result=valeur/1000;
if (result!=0) {
Printf(result+0x30);
zero=0;
}
else if (zero==0) Printf('0');
valeur=valeur%1000;
result=valeur/100;
if (result!=0) {
Printf(result+0x30);
zero=0;
}
else if (zero==0) Printf('0');
valeur=valeur%100;
result=valeur/10;
if (result!=0) {
Printf(result+0x30);
zero=0;
}
else if (zero==0) Printf('0');
result=valeur%10;
Printf(result+0x30);
}

// convert 16 bits binary value to HEX and send it on the UART

void Print_hex(unsigned int valeur)
{
const char hexa[] = {'0','1','2','3','4','5','6','7','8','9','A','B','C','D','E','F'};

Printf(hexa[(valeur>>12)&0x000F]);
Printf(hexa[(valeur>>8)&0x000F]);
Printf(hexa[(valeur>>4)&0x000F]);
Printf(hexa[valeur&0x000F]);
}

// convert 16 bits binary value to byte and send it on the UART

void Print_byte(unsigned int valeur)
{
unsigned int result;
result=valeur;
Printf(result);
}

Referencias


http://picmania.garcia-cuervo.net/picc.php#COMBUF232
http://picmania.garcia-cuervo.net/picc_servos_x_8.php
http://sdcc.sourceforge.net/doc/sdccman.pdf
http://pinguino.walii.es/archives/161
http://karoshi.auic.es/index.php?topic=1689.0
http://jpmandon.blogspot.com/