void enviar_comando(unsigned char direccion, unsigned char comando, unsigned char parametros[3]){
    unsigned char i;
    SBUF=direccion;
    while(TI==1);
    SBUF=comando;
    while(TI==1);
    for(i=0;i<3;i++){
        trama[2+i]=parametros[i];
        while(TI==1);
    }
}