Quelle  mixart_hwdep.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * Driver for Digigram miXart soundcards
 *
 * DSP firmware management
 *
 * Copyright (c) 2003 by Digigram <alsa@digigram.com>
 */

#include <linux/interrupt.h>
#include <linux/pci.h>
#include <linux/firmware.h>
#include <linux/vmalloc.h>
#include <linux/slab.h>
#include <linux/module.h>
#include <linux/io.h>
#include <sound/core.h>
#include "mixart.h"
#include "mixart_mixer.h"
#include "mixart_core.h"
#include "mixart_hwdep.h"


/**
 * mixart_wait_nice_for_register_value - wait for a value on a peudo register,
 * exit with a timeout
 *
 * @mgr: pointer to miXart manager structure
 * @offset: unsigned pseudo_register base + offset of value
 * @is_egal: wait for the equal value
 * @value: value
 * @timeout: timeout in centisenconds
 */
static int mixart_wait_nice_for_register_value(struct mixart_mgr *mgr,
            u32 offset, int is_egal,
            u32 value, unsigned long timeout)
{
 unsigned long end_time = jiffies + (timeout * HZ / 100);
 u32 read;

 do { /* we may take too long time in this loop.
 * so give controls back to kernel if needed.
 */
  cond_resched();

  read = readl_be( MIXART_MEM( mgr, offset ));
  if(is_egal) {
   if(read == value) return 0;
  }
  else { /* wait for different value */
   if(read != value) return 0;
  }
 } while ( time_after_eq(end_time, jiffies) );

 return -EBUSY;
}


/*
  structures needed to upload elf code packets 
 */
struct snd_mixart_elf32_ehdr {
 u8      e_ident[16];
 __be16  e_type;
 __be16  e_machine;
 __be32  e_version;
 __be32  e_entry;
 __be32  e_phoff;
 __be32  e_shoff;
 __be32  e_flags;
 __be16  e_ehsize;
 __be16  e_phentsize;
 __be16  e_phnum;
 __be16  e_shentsize;
 __be16  e_shnum;
 __be16  e_shstrndx;
};

struct snd_mixart_elf32_phdr {
 __be32  p_type;
 __be32  p_offset;
 __be32  p_vaddr;
 __be32  p_paddr;
 __be32  p_filesz;
 __be32  p_memsz;
 __be32  p_flags;
 __be32  p_align;
};

static int mixart_load_elf(struct mixart_mgr *mgr, const struct firmware *dsp )
{
 char                    elf32_magic_number[4] = {0x7f,'E','L','F'};
 struct snd_mixart_elf32_ehdr *elf_header;
 int                     i;

 elf_header = (struct snd_mixart_elf32_ehdr *)dsp->data;
 for( i=0; i<4; i++ )
  if ( elf32_magic_number[i] != elf_header->e_ident[i] )
   return -EINVAL;

 if( elf_header->e_phoff != 0 ) {
  struct snd_mixart_elf32_phdr     elf_programheader;

  for( i=0; i < be16_to_cpu(elf_header->e_phnum); i++ ) {
   u32 pos = be32_to_cpu(elf_header->e_phoff) + (u32)(i * be16_to_cpu(elf_header->e_phentsize));

   memcpy( &elf_programheader, dsp->data + pos, sizeof(elf_programheader) );

   if(elf_programheader.p_type != 0) {
    if( elf_programheader.p_filesz != 0 ) {
     memcpy_toio( MIXART_MEM( mgr, be32_to_cpu(elf_programheader.p_vaddr)),
           dsp->data + be32_to_cpu( elf_programheader.p_offset ),
           be32_to_cpu( elf_programheader.p_filesz ));
    }
   }
  }
 }
 return 0;
}

/*
 * get basic information and init miXart
 */

/* audio IDs for request to the board */
#define MIXART_FIRST_ANA_AUDIO_ID       0
#define MIXART_FIRST_DIG_AUDIO_ID       8

static int mixart_enum_connectors(struct mixart_mgr *mgr)
{
 u32 k;
 int err;
 struct mixart_msg request;
 struct mixart_enum_connector_resp *connector;
 struct mixart_audio_info_req  *audio_info_req;
 struct mixart_audio_info_resp *audio_info;

 connector = kmalloc(sizeof(*connector), GFP_KERNEL);
 audio_info_req = kmalloc(sizeof(*audio_info_req), GFP_KERNEL);
 audio_info = kmalloc(sizeof(*audio_info), GFP_KERNEL);
 if (! connector || ! audio_info_req || ! audio_info) {
  err = -ENOMEM;
  goto __error;
 }

 audio_info_req->line_max_level = MIXART_FLOAT_P_22_0_TO_HEX;
 audio_info_req->micro_max_level = MIXART_FLOAT_M_20_0_TO_HEX;
 audio_info_req->cd_max_level = MIXART_FLOAT____0_0_TO_HEX;

 request.message_id = MSG_SYSTEM_ENUM_PLAY_CONNECTOR;
 request.uid = (struct mixart_uid){0,0};  /* board num = 0 */
 request.data = NULL;
 request.size = 0;

 err = snd_mixart_send_msg(mgr, &request, sizeof(*connector), connector);
 if((err < 0) || (connector->error_code) || (connector->uid_count > MIXART_MAX_PHYS_CONNECTORS)) {
  dev_err(&mgr->pci->dev,
   "error MSG_SYSTEM_ENUM_PLAY_CONNECTOR\n");
  err = -EINVAL;
  goto __error;
 }

 for(k=0; k < connector->uid_count; k++) {
  struct mixart_pipe *pipe;

  if(k < MIXART_FIRST_DIG_AUDIO_ID) {
   pipe = &mgr->chip[k/2]->pipe_out_ana;
  } else {
   pipe = &mgr->chip[(k-MIXART_FIRST_DIG_AUDIO_ID)/2]->pipe_out_dig;
  }
  if(k & 1) {
   pipe->uid_right_connector = connector->uid[k];   /* odd */
  } else {
   pipe->uid_left_connector = connector->uid[k];    /* even */
  }

  /* dev_dbg(&mgr->pci->dev, "playback connector[%d].object_id = %x\n", k, connector->uid[k].object_id); */

  /* TODO: really need send_msg MSG_CONNECTOR_GET_AUDIO_INFO for each connector ? perhaps for analog level caps ? */
  request.message_id = MSG_CONNECTOR_GET_AUDIO_INFO;
  request.uid = connector->uid[k];
  request.data = audio_info_req;
  request.size = sizeof(*audio_info_req);

  err = snd_mixart_send_msg(mgr, &request, sizeof(*audio_info), audio_info);
  if( err < 0 ) {
   dev_err(&mgr->pci->dev,
    "error MSG_CONNECTOR_GET_AUDIO_INFO\n");
   goto __error;
  }
  /*dev_dbg(&mgr->pci->dev, "play  analog_info.analog_level_present = %x\n", audio_info->info.analog_info.analog_level_present);*/
 }

 request.message_id = MSG_SYSTEM_ENUM_RECORD_CONNECTOR;
 request.uid = (struct mixart_uid){0,0};  /* board num = 0 */
 request.data = NULL;
 request.size = 0;

 err = snd_mixart_send_msg(mgr, &request, sizeof(*connector), connector);
 if((err < 0) || (connector->error_code) || (connector->uid_count > MIXART_MAX_PHYS_CONNECTORS)) {
  dev_err(&mgr->pci->dev,
   "error MSG_SYSTEM_ENUM_RECORD_CONNECTOR\n");
  err = -EINVAL;
  goto __error;
 }

 for(k=0; k < connector->uid_count; k++) {
  struct mixart_pipe *pipe;

  if(k < MIXART_FIRST_DIG_AUDIO_ID) {
   pipe = &mgr->chip[k/2]->pipe_in_ana;
  } else {
   pipe = &mgr->chip[(k-MIXART_FIRST_DIG_AUDIO_ID)/2]->pipe_in_dig;
  }
  if(k & 1) {
   pipe->uid_right_connector = connector->uid[k];   /* odd */
  } else {
   pipe->uid_left_connector = connector->uid[k];    /* even */
  }

  /* dev_dbg(&mgr->pci->dev, "capture connector[%d].object_id = %x\n", k, connector->uid[k].object_id); */

  /* TODO: really need send_msg MSG_CONNECTOR_GET_AUDIO_INFO for each connector ? perhaps for analog level caps ? */
  request.message_id = MSG_CONNECTOR_GET_AUDIO_INFO;
  request.uid = connector->uid[k];
  request.data = audio_info_req;
  request.size = sizeof(*audio_info_req);

  err = snd_mixart_send_msg(mgr, &request, sizeof(*audio_info), audio_info);
  if( err < 0 ) {
   dev_err(&mgr->pci->dev,
    "error MSG_CONNECTOR_GET_AUDIO_INFO\n");
   goto __error;
  }
  /*dev_dbg(&mgr->pci->dev, "rec  analog_info.analog_level_present = %x\n", audio_info->info.analog_info.analog_level_present);*/
 }
 err = 0;

 __error:
 kfree(connector);
 kfree(audio_info_req);
 kfree(audio_info);

 return err;
}

static int mixart_enum_physio(struct mixart_mgr *mgr)
{
 u32 k;
 int err;
 struct mixart_msg request;
 struct mixart_uid get_console_mgr;
 struct mixart_return_uid console_mgr;
 struct mixart_uid_enumeration phys_io;

 /* get the uid for the console manager */
 get_console_mgr.object_id = 0;
 get_console_mgr.desc = MSG_CONSOLE_MANAGER | 0; /* cardindex = 0 */

 request.message_id = MSG_CONSOLE_GET_CLOCK_UID;
 request.uid = get_console_mgr;
 request.data = &get_console_mgr;
 request.size = sizeof(get_console_mgr);

 err = snd_mixart_send_msg(mgr, &request, sizeof(console_mgr), &console_mgr);

 if( (err < 0) || (console_mgr.error_code != 0) ) {
  dev_dbg(&mgr->pci->dev,
   "error MSG_CONSOLE_GET_CLOCK_UID : err=%x\n",
   console_mgr.error_code);
  return -EINVAL;
 }

 /* used later for clock issues ! */
 mgr->uid_console_manager = console_mgr.uid;

 request.message_id = MSG_SYSTEM_ENUM_PHYSICAL_IO;
 request.uid = (struct mixart_uid){0,0};
 request.data = &console_mgr.uid;
 request.size = sizeof(console_mgr.uid);

 err = snd_mixart_send_msg(mgr, &request, sizeof(phys_io), &phys_io);
 if( (err < 0) || ( phys_io.error_code != 0 ) ) {
  dev_err(&mgr->pci->dev,
   "error MSG_SYSTEM_ENUM_PHYSICAL_IO err(%x) error_code(%x)\n",
   err, phys_io.error_code);
  return -EINVAL;
 }

 /* min 2 phys io per card (analog in + analog out) */
 if (phys_io.nb_uid < MIXART_MAX_CARDS * 2)
  return -EINVAL;

 for(k=0; k<mgr->num_cards; k++) {
  mgr->chip[k]->uid_in_analog_physio = phys_io.uid[k];
  mgr->chip[k]->uid_out_analog_physio = phys_io.uid[phys_io.nb_uid/2 + k]; 
 }

 return 0;
}


static int mixart_first_init(struct mixart_mgr *mgr)
{
 u32 k;
 int err;
 struct mixart_msg request;

 err = mixart_enum_connectors(mgr);
 if (err < 0)
  return err;

 err = mixart_enum_physio(mgr);
 if (err < 0)
  return err;

 /* send a synchro command to card (necessary to do this before first MSG_STREAM_START_STREAM_GRP_PACKET) */
 /* though why not here */
 request.message_id = MSG_SYSTEM_SEND_SYNCHRO_CMD;
 request.uid = (struct mixart_uid){0,0};
 request.data = NULL;
 request.size = 0;
 /* this command has no data. response is a 32 bit status */
 err = snd_mixart_send_msg(mgr, &request, sizeof(k), &k);
 if( (err < 0) || (k != 0) ) {
  dev_err(&mgr->pci->dev, "error MSG_SYSTEM_SEND_SYNCHRO_CMD\n");
  return err == 0 ? -EINVAL : err;
 }

 return 0;
}


/* firmware base addresses (when hard coded) */
#define MIXART_MOTHERBOARD_XLX_BASE_ADDRESS   0x00600000

static int mixart_dsp_load(struct mixart_mgr* mgr, int index, const struct firmware *dsp)
{
 int           err, card_index;
 u32           status_xilinx, status_elf, status_daught;
 u32           val;

 /* read motherboard xilinx status */
 status_xilinx = readl_be( MIXART_MEM( mgr,MIXART_PSEUDOREG_MXLX_STATUS_OFFSET ));
 /* read elf status */
 status_elf = readl_be( MIXART_MEM( mgr,MIXART_PSEUDOREG_ELF_STATUS_OFFSET ));
 /* read daughterboard xilinx status */
 status_daught = readl_be( MIXART_MEM( mgr,MIXART_PSEUDOREG_DXLX_STATUS_OFFSET ));

 /* motherboard xilinx status 5 will say that the board is performing a reset */
 if (status_xilinx == 5) {
  dev_err(&mgr->pci->dev, "miXart is resetting !\n");
  return -EAGAIN; /* try again later */
 }

 switch (index)   {
 case MIXART_MOTHERBOARD_XLX_INDEX:

  /* xilinx already loaded ? */ 
  if (status_xilinx == 4) {
   dev_dbg(&mgr->pci->dev, "xilinx is already loaded !\n");
   return 0;
  }
  /* the status should be 0 == "idle" */
  if (status_xilinx != 0) {
   dev_err(&mgr->pci->dev,
    "xilinx load error ! status = %d\n",
       status_xilinx);
   return -EIO; /* modprob -r may help ? */
  }

  /* check xilinx validity */
  if (((u32*)(dsp->data))[0] == 0xffffffff)
   return -EINVAL;
  if (dsp->size % 4)
   return -EINVAL;

  /* set xilinx status to copying */
  writel_be( 1, MIXART_MEM( mgr, MIXART_PSEUDOREG_MXLX_STATUS_OFFSET ));

  /* setup xilinx base address */
  writel_be( MIXART_MOTHERBOARD_XLX_BASE_ADDRESS, MIXART_MEM( mgr,MIXART_PSEUDOREG_MXLX_BASE_ADDR_OFFSET ));
  /* setup code size for xilinx file */
  writel_be( dsp->size, MIXART_MEM( mgr, MIXART_PSEUDOREG_MXLX_SIZE_OFFSET ));

  /* copy xilinx code */
  memcpy_toio(  MIXART_MEM( mgr, MIXART_MOTHERBOARD_XLX_BASE_ADDRESS),  dsp->data,  dsp->size);
    
  /* set xilinx status to copy finished */
  writel_be( 2, MIXART_MEM( mgr, MIXART_PSEUDOREG_MXLX_STATUS_OFFSET ));

  /* return, because no further processing needed */
  return 0;

 case MIXART_MOTHERBOARD_ELF_INDEX:

  if (status_elf == 4) {
   dev_dbg(&mgr->pci->dev, "elf file already loaded !\n");
   return 0;
  }

  /* the status should be 0 == "idle" */
  if (status_elf != 0) {
   dev_err(&mgr->pci->dev,
    "elf load error ! status = %d\n",
       status_elf);
   return -EIO; /* modprob -r may help ? */
  }

  /* wait for xilinx status == 4 */
  err = mixart_wait_nice_for_register_value( mgr, MIXART_PSEUDOREG_MXLX_STATUS_OFFSET, 1, 4, 500); /* 5sec */
  if (err < 0) {
   dev_err(&mgr->pci->dev, "xilinx was not loaded or "
       "could not be started\n");
   return err;
  }

  /* init some data on the card */
  writel_be( 0, MIXART_MEM( mgr, MIXART_PSEUDOREG_BOARDNUMBER ) ); /* set miXart boardnumber to 0 */
  writel_be( 0, MIXART_MEM( mgr, MIXART_FLOWTABLE_PTR ) );         /* reset pointer to flow table on miXart */

  /* set elf status to copying */
  writel_be( 1, MIXART_MEM( mgr, MIXART_PSEUDOREG_ELF_STATUS_OFFSET ));

  /* process the copying of the elf packets */
  err = mixart_load_elf( mgr, dsp );
  if (err < 0) return err;

  /* set elf status to copy finished */
  writel_be( 2, MIXART_MEM( mgr, MIXART_PSEUDOREG_ELF_STATUS_OFFSET ));

  /* wait for elf status == 4 */
  err = mixart_wait_nice_for_register_value( mgr, MIXART_PSEUDOREG_ELF_STATUS_OFFSET, 1, 4, 300); /* 3sec */
  if (err < 0) {
   dev_err(&mgr->pci->dev, "elf could not be started\n");
   return err;
  }

  /* miXart waits at this point on the pointer to the flow table */
  writel_be( (u32)mgr->flowinfo.addr, MIXART_MEM( mgr, MIXART_FLOWTABLE_PTR ) ); /* give pointer of flow table to miXart */

  return 0;  /* return, another xilinx file has to be loaded before */

 case MIXART_AESEBUBOARD_XLX_INDEX:
 default:

  /* elf and xilinx should be loaded */
  if (status_elf != 4 || status_xilinx != 4) {
   dev_err(&mgr->pci->dev, "xilinx or elf not "
          "successfully loaded\n");
   return -EIO; /* modprob -r may help ? */
  }

  /* wait for daughter detection != 0 */
  err = mixart_wait_nice_for_register_value( mgr, MIXART_PSEUDOREG_DBRD_PRESENCE_OFFSET, 0, 0, 30); /* 300msec */
  if (err < 0) {
   dev_err(&mgr->pci->dev, "error starting elf file\n");
   return err;
  }

  /* the board type can now be retrieved */
  mgr->board_type = (DAUGHTER_TYPE_MASK & readl_be( MIXART_MEM( mgr, MIXART_PSEUDOREG_DBRD_TYPE_OFFSET)));

  if (mgr->board_type == MIXART_DAUGHTER_TYPE_NONE)
   break;  /* no daughter board; the file does not have to be loaded, continue after the switch */

  /* only if aesebu daughter board presence (elf code must run)  */ 
  if (mgr->board_type != MIXART_DAUGHTER_TYPE_AES )
   return -EINVAL;

  /* daughter should be idle */
  if (status_daught != 0) {
   dev_err(&mgr->pci->dev,
    "daughter load error ! status = %d\n",
          status_daught);
   return -EIO; /* modprob -r may help ? */
  }
 
  /* check daughterboard xilinx validity */
  if (((u32*)(dsp->data))[0] == 0xffffffff)
   return -EINVAL;
  if (dsp->size % 4)
   return -EINVAL;

  /* inform mixart about the size of the file */
  writel_be( dsp->size, MIXART_MEM( mgr, MIXART_PSEUDOREG_DXLX_SIZE_OFFSET ));

  /* set daughterboard status to 1 */
  writel_be( 1, MIXART_MEM( mgr, MIXART_PSEUDOREG_DXLX_STATUS_OFFSET ));

  /* wait for status == 2 */
  err = mixart_wait_nice_for_register_value( mgr, MIXART_PSEUDOREG_DXLX_STATUS_OFFSET, 1, 2, 30); /* 300msec */
  if (err < 0) {
   dev_err(&mgr->pci->dev, "daughter board load error\n");
   return err;
  }

  /* get the address where to write the file */
  val = readl_be( MIXART_MEM( mgr, MIXART_PSEUDOREG_DXLX_BASE_ADDR_OFFSET ));
  if (!val)
   return -EINVAL;

  /* copy daughterboard xilinx code */
  memcpy_toio(  MIXART_MEM( mgr, val),  dsp->data,  dsp->size);

  /* set daughterboard status to 4 */
  writel_be( 4, MIXART_MEM( mgr, MIXART_PSEUDOREG_DXLX_STATUS_OFFSET ));

  /* continue with init */
  break;
 } /* end of switch file index*/

        /* wait for daughter status == 3 */
        err = mixart_wait_nice_for_register_value( mgr, MIXART_PSEUDOREG_DXLX_STATUS_OFFSET, 1, 3, 300); /* 3sec */
        if (err < 0) {
  dev_err(&mgr->pci->dev,
      "daughter board could not be initialised\n");
  return err;
 }

 /* init mailbox (communication with embedded) */
 snd_mixart_init_mailbox(mgr);

 /* first communication with embedded */
 err = mixart_first_init(mgr);
        if (err < 0) {
  dev_err(&mgr->pci->dev, "miXart could not be set up\n");
  return err;
 }

        /* create devices and mixer in accordance with HW options*/
        for (card_index = 0; card_index < mgr->num_cards; card_index++) {
  struct snd_mixart *chip = mgr->chip[card_index];

  err = snd_mixart_create_pcm(chip);
  if (err < 0)
   return err;

  if (card_index == 0) {
   err = snd_mixart_create_mixer(chip->mgr);
   if (err < 0)
           return err;
  }

  err = snd_card_register(chip->card);
  if (err < 0)
   return err;
 }

 dev_dbg(&mgr->pci->dev,
  "miXart firmware downloaded and successfully set up\n");

 return 0;
}


int snd_mixart_setup_firmware(struct mixart_mgr *mgr)
{
 static const char * const fw_files[3] = {
  "miXart8.xlx", "miXart8.elf", "miXart8AES.xlx"
 };
 char path[32];

 const struct firmware *fw_entry;
 int i, err;

 for (i = 0; i < 3; i++) {
  sprintf(path, "mixart/%s", fw_files[i]);
  if (request_firmware(&fw_entry, path, &mgr->pci->dev)) {
   dev_err(&mgr->pci->dev,
    "miXart: can't load firmware %s\n", path);
   return -ENOENT;
  }
  /* fake hwdep dsp record */
  err = mixart_dsp_load(mgr, i, fw_entry);
  release_firmware(fw_entry);
  if (err < 0)
   return err;
  mgr->dsp_loaded |= 1 << i;
 }
 return 0;
}

MODULE_FIRMWARE("mixart/miXart8.xlx");
MODULE_FIRMWARE("mixart/miXart8.elf");
MODULE_FIRMWARE("mixart/miXart8AES.xlx");