freebsd-dev/sys/dev/ips/ips_commands.c
2005-11-29 09:39:41 +00:00

672 lines
20 KiB
C

/*-
* Written by: David Jeffery
* Copyright (c) 2002 Adaptec Inc.
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*/
#include <sys/cdefs.h>
__FBSDID("$FreeBSD$");
#include <dev/ips/ipsreg.h>
#include <dev/ips/ips.h>
/*
* This is an interrupt callback. It is called from
* interrupt context when the adapter has completed the
* command. This very generic callback simply stores
* the command's return value in command->arg and wake's
* up anyone waiting on the command.
*/
static void ips_wakeup_callback(ips_command_t *command)
{
bus_dmamap_sync(command->sc->command_dmatag, command->command_dmamap,
BUS_DMASYNC_POSTWRITE);
sema_post(&command->sc->cmd_sema);
}
/* Below are a series of functions for sending an IO request
* to the adapter. The flow order is: start, send, callback, finish.
* The caller must have already assembled an iorequest struct to hold
* the details of the IO request. */
static void ips_io_request_finish(ips_command_t *command)
{
struct bio *iobuf = command->arg;
if(ips_read_request(iobuf)) {
bus_dmamap_sync(command->data_dmatag, command->data_dmamap,
BUS_DMASYNC_POSTREAD);
} else {
bus_dmamap_sync(command->data_dmatag, command->data_dmamap,
BUS_DMASYNC_POSTWRITE);
}
bus_dmamap_unload(command->data_dmatag, command->data_dmamap);
if(COMMAND_ERROR(command)){
iobuf->bio_flags |=BIO_ERROR;
iobuf->bio_error = EIO;
printf("ips: io error, status= 0x%x\n", command->status.value);
}
ips_insert_free_cmd(command->sc, command);
ipsd_finish(iobuf);
}
static void ips_io_request_callback(void *cmdptr, bus_dma_segment_t *segments,int segnum, int error)
{
ips_softc_t *sc;
ips_command_t *command = cmdptr;
ips_sg_element_t *sg_list;
ips_io_cmd *command_struct;
struct bio *iobuf = command->arg;
int i, length = 0;
u_int8_t cmdtype;
sc = command->sc;
if(error){
printf("ips: error = %d in ips_sg_request_callback\n", error);
bus_dmamap_unload(command->data_dmatag, command->data_dmamap);
iobuf->bio_flags |= BIO_ERROR;
iobuf->bio_error = ENOMEM;
ips_insert_free_cmd(sc, command);
ipsd_finish(iobuf);
return;
}
command_struct = (ips_io_cmd *)command->command_buffer;
command_struct->id = command->id;
command_struct->drivenum = (uintptr_t)iobuf->bio_driver1;
if(segnum != 1){
if(ips_read_request(iobuf))
cmdtype = IPS_SG_READ_CMD;
else
cmdtype = IPS_SG_WRITE_CMD;
command_struct->segnum = segnum;
sg_list = (ips_sg_element_t *)((u_int8_t *)
command->command_buffer + IPS_COMMAND_LEN);
for(i = 0; i < segnum; i++){
sg_list[i].addr = segments[i].ds_addr;
sg_list[i].len = segments[i].ds_len;
length += segments[i].ds_len;
}
command_struct->buffaddr =
(u_int32_t)command->command_phys_addr + IPS_COMMAND_LEN;
} else {
if(ips_read_request(iobuf))
cmdtype = IPS_READ_CMD;
else
cmdtype = IPS_WRITE_CMD;
command_struct->buffaddr = segments[0].ds_addr;
length = segments[0].ds_len;
}
command_struct->command = cmdtype;
command_struct->lba = iobuf->bio_pblkno;
length = (length + IPS_BLKSIZE - 1)/IPS_BLKSIZE;
command_struct->length = length;
bus_dmamap_sync(sc->command_dmatag, command->command_dmamap,
BUS_DMASYNC_PREWRITE);
if(ips_read_request(iobuf)) {
bus_dmamap_sync(command->data_dmatag, command->data_dmamap,
BUS_DMASYNC_PREREAD);
} else {
bus_dmamap_sync(command->data_dmatag, command->data_dmamap,
BUS_DMASYNC_PREWRITE);
}
PRINTF(10, "ips test: command id: %d segments: %d "
"pblkno: %lld length: %d, ds_len: %d\n", command->id, segnum,
iobuf->bio_pblkno,
length, segments[0].ds_len);
sc->ips_issue_cmd(command);
return;
}
static int ips_send_io_request(ips_command_t *command, struct bio *iobuf)
{
command->callback = ips_io_request_finish;
command->arg = iobuf;
PRINTF(10, "ips test: : bcount %ld\n", iobuf->bio_bcount);
bus_dmamap_load(command->data_dmatag, command->data_dmamap,
iobuf->bio_data, iobuf->bio_bcount,
ips_io_request_callback, command, 0);
return 0;
}
void ips_start_io_request(ips_softc_t *sc)
{
struct bio *iobuf;
ips_command_t *command;
iobuf = bioq_first(&sc->queue);
if(!iobuf)
return;
if (ips_get_free_cmd(sc, &command, 0))
return;
bioq_remove(&sc->queue, iobuf);
ips_send_io_request(command, iobuf);
return;
}
/* Below are a series of functions for sending an adapter info request
* to the adapter. The flow order is: get, send, callback. It uses
* the generic finish callback at the top of this file.
* This can be used to get configuration/status info from the card */
static void ips_adapter_info_callback(void *cmdptr, bus_dma_segment_t *segments,int segnum, int error)
{
ips_softc_t *sc;
ips_command_t *command = cmdptr;
ips_adapter_info_cmd *command_struct;
sc = command->sc;
if(error){
ips_set_error(command, error);
printf("ips: error = %d in ips_get_adapter_info\n", error);
return;
}
command_struct = (ips_adapter_info_cmd *)command->command_buffer;
command_struct->command = IPS_ADAPTER_INFO_CMD;
command_struct->id = command->id;
command_struct->buffaddr = segments[0].ds_addr;
bus_dmamap_sync(sc->command_dmatag, command->command_dmamap,
BUS_DMASYNC_PREWRITE);
bus_dmamap_sync(command->data_dmatag, command->data_dmamap,
BUS_DMASYNC_PREREAD);
sc->ips_issue_cmd(command);
if (sema_timedwait(&sc->cmd_sema, 30*hz) != 0) {
ips_set_error(command, ETIMEDOUT);
return;
}
bus_dmamap_sync(command->data_dmatag, command->data_dmamap,
BUS_DMASYNC_POSTREAD);
memcpy(&(sc->adapter_info), command->data_buffer, IPS_ADAPTER_INFO_LEN);
}
static int ips_send_adapter_info_cmd(ips_command_t *command)
{
int error = 0;
ips_softc_t *sc = command->sc;
if (bus_dma_tag_create( /* parent */ sc->adapter_dmatag,
/* alignemnt */ 1,
/* boundary */ 0,
/* lowaddr */ BUS_SPACE_MAXADDR_32BIT,
/* highaddr */ BUS_SPACE_MAXADDR,
/* filter */ NULL,
/* filterarg */ NULL,
/* maxsize */ IPS_ADAPTER_INFO_LEN,
/* numsegs */ 1,
/* maxsegsize*/ IPS_ADAPTER_INFO_LEN,
/* flags */ 0,
/* lockfunc */ NULL,
/* lockarg */ NULL,
&command->data_dmatag) != 0) {
printf("ips: can't alloc dma tag for adapter status\n");
error = ENOMEM;
goto exit;
}
if(bus_dmamem_alloc(command->data_dmatag, &command->data_buffer,
BUS_DMA_NOWAIT, &command->data_dmamap)){
error = ENOMEM;
goto exit;
}
command->callback = ips_wakeup_callback;
error = bus_dmamap_load(command->data_dmatag, command->data_dmamap,
command->data_buffer,IPS_ADAPTER_INFO_LEN,
ips_adapter_info_callback, command,
BUS_DMA_NOWAIT);
if (error == 0)
bus_dmamap_unload(command->data_dmatag, command->data_dmamap);
exit:
/* I suppose I should clean up my memory allocations */
bus_dmamem_free(command->data_dmatag, command->data_buffer,
command->data_dmamap);
bus_dma_tag_destroy(command->data_dmatag);
ips_insert_free_cmd(sc, command);
return error;
}
int ips_get_adapter_info(ips_softc_t *sc)
{
ips_command_t *command;
int error = 0;
if (ips_get_free_cmd(sc, &command, IPS_STATIC_FLAG) > 0){
device_printf(sc->dev, "unable to get adapter configuration\n");
return ENXIO;
}
ips_send_adapter_info_cmd(command);
if (COMMAND_ERROR(command)){
error = ENXIO;
}
return error;
}
/* Below are a series of functions for sending a drive info request
* to the adapter. The flow order is: get, send, callback. It uses
* the generic finish callback at the top of this file.
* This can be used to get drive status info from the card */
static void ips_drive_info_callback(void *cmdptr, bus_dma_segment_t *segments,int segnum, int error)
{
ips_softc_t *sc;
ips_command_t *command = cmdptr;
ips_drive_cmd *command_struct;
ips_drive_info_t *driveinfo;
sc = command->sc;
if(error){
ips_set_error(command, error);
printf("ips: error = %d in ips_get_drive_info\n", error);
return;
}
command_struct = (ips_drive_cmd *)command->command_buffer;
command_struct->command = IPS_DRIVE_INFO_CMD;
command_struct->id = command->id;
command_struct->buffaddr = segments[0].ds_addr;
bus_dmamap_sync(sc->command_dmatag, command->command_dmamap,
BUS_DMASYNC_PREWRITE);
bus_dmamap_sync(command->data_dmatag, command->data_dmamap,
BUS_DMASYNC_PREREAD);
sc->ips_issue_cmd(command);
if (sema_timedwait(&sc->cmd_sema, 10*hz) != 0) {
ips_set_error(command, ETIMEDOUT);
return;
}
bus_dmamap_sync(command->data_dmatag, command->data_dmamap,
BUS_DMASYNC_POSTREAD);
driveinfo = command->data_buffer;
memcpy(sc->drives, driveinfo->drives, sizeof(ips_drive_t) * 8);
sc->drivecount = driveinfo->drivecount;
device_printf(sc->dev, "logical drives: %d\n",sc->drivecount);
}
static int ips_send_drive_info_cmd(ips_command_t *command)
{
int error = 0;
ips_softc_t *sc = command->sc;
if (bus_dma_tag_create( /* parent */ sc->adapter_dmatag,
/* alignemnt */ 1,
/* boundary */ 0,
/* lowaddr */ BUS_SPACE_MAXADDR_32BIT,
/* highaddr */ BUS_SPACE_MAXADDR,
/* filter */ NULL,
/* filterarg */ NULL,
/* maxsize */ IPS_DRIVE_INFO_LEN,
/* numsegs */ 1,
/* maxsegsize*/ IPS_DRIVE_INFO_LEN,
/* flags */ 0,
/* lockfunc */ NULL,
/* lockarg */ NULL,
&command->data_dmatag) != 0) {
printf("ips: can't alloc dma tag for drive status\n");
error = ENOMEM;
goto exit;
}
if(bus_dmamem_alloc(command->data_dmatag, &command->data_buffer,
BUS_DMA_NOWAIT, &command->data_dmamap)){
error = ENOMEM;
goto exit;
}
command->callback = ips_wakeup_callback;
error = bus_dmamap_load(command->data_dmatag, command->data_dmamap,
command->data_buffer,IPS_DRIVE_INFO_LEN,
ips_drive_info_callback, command,
BUS_DMA_NOWAIT);
if (error == 0)
bus_dmamap_unload(command->data_dmatag, command->data_dmamap);
exit:
/* I suppose I should clean up my memory allocations */
bus_dmamem_free(command->data_dmatag, command->data_buffer,
command->data_dmamap);
bus_dma_tag_destroy(command->data_dmatag);
ips_insert_free_cmd(sc, command);
return error;
}
int ips_get_drive_info(ips_softc_t *sc)
{
int error = 0;
ips_command_t *command;
if (ips_get_free_cmd(sc, &command, IPS_STATIC_FLAG) > 0){
device_printf(sc->dev, "unable to get drive configuration\n");
return ENXIO;
}
ips_send_drive_info_cmd(command);
if(COMMAND_ERROR(command)){
error = ENXIO;
}
return error;
}
/* Below is a pair of functions for making sure data is safely
* on disk by flushing the adapter's cache. */
static int ips_send_flush_cache_cmd(ips_command_t *command)
{
ips_softc_t *sc = command->sc;
ips_generic_cmd *command_struct;
PRINTF(10,"ips test: got a command, building flush command\n");
command->callback = ips_wakeup_callback;
command_struct = (ips_generic_cmd *)command->command_buffer;
command_struct->command = IPS_CACHE_FLUSH_CMD;
command_struct->id = command->id;
bus_dmamap_sync(sc->command_dmatag, command->command_dmamap,
BUS_DMASYNC_PREWRITE);
sc->ips_issue_cmd(command);
if (COMMAND_ERROR(command) == 0)
sema_wait(&sc->cmd_sema);
ips_insert_free_cmd(sc, command);
return 0;
}
int ips_flush_cache(ips_softc_t *sc)
{
ips_command_t *command;
device_printf(sc->dev, "flushing cache\n");
if (ips_get_free_cmd(sc, &command, IPS_STATIC_FLAG)){
device_printf(sc->dev, "ERROR: unable to get a command! can't flush cache!\n");
}
ips_send_flush_cache_cmd(command);
if(COMMAND_ERROR(command)){
device_printf(sc->dev, "ERROR: cache flush command failed!\n");
}
return 0;
}
/* Simplified localtime to provide timevalues for ffdc.
* Taken from libc/stdtime/localtime.c
*/
void static ips_ffdc_settime(ips_adapter_ffdc_cmd *command, time_t sctime)
{
long days, rem, y;
int yleap, *ip, month;
int year_lengths[2] = { IPS_DAYSPERNYEAR, IPS_DAYSPERLYEAR };
int mon_lengths[2][IPS_MONSPERYEAR] = {
{ 31, 28, 31, 30, 31, 30, 31, 31, 30, 31, 30, 31 },
{ 31, 29, 31, 30, 31, 30, 31, 31, 30, 31, 30, 31 }
};
days = sctime / IPS_SECSPERDAY;
rem = sctime % IPS_SECSPERDAY;
command->hour = rem / IPS_SECSPERHOUR;
rem = rem % IPS_SECSPERHOUR;
command->minute = rem / IPS_SECSPERMIN;
command->second = rem % IPS_SECSPERMIN;
y = IPS_EPOCH_YEAR;
while (days < 0 || days >= (long) year_lengths[yleap = ips_isleap(y)]) {
long newy;
newy = y + days / IPS_DAYSPERNYEAR;
if (days < 0)
--newy;
days -= (newy - y) * IPS_DAYSPERNYEAR +
IPS_LEAPS_THRU_END_OF(newy - 1) -
IPS_LEAPS_THRU_END_OF(y - 1);
y = newy;
}
command->yearH = y / 100;
command->yearL = y % 100;
ip = mon_lengths[yleap];
for(month = 0; days >= (long) ip[month]; ++month)
days = days - (long) ip[month];
command->month = month + 1;
command->day = days + 1;
}
static int ips_send_ffdc_reset_cmd(ips_command_t *command)
{
ips_softc_t *sc = command->sc;
ips_adapter_ffdc_cmd *command_struct;
PRINTF(10,"ips test: got a command, building ffdc reset command\n");
command->callback = ips_wakeup_callback;
command_struct = (ips_adapter_ffdc_cmd *)command->command_buffer;
command_struct->command = IPS_FFDC_CMD;
command_struct->id = command->id;
command_struct->reset_count = sc->ffdc_resetcount;
command_struct->reset_type = 0x0;
ips_ffdc_settime(command_struct, sc->ffdc_resettime.tv_sec);
bus_dmamap_sync(sc->command_dmatag, command->command_dmamap,
BUS_DMASYNC_PREWRITE);
sc->ips_issue_cmd(command);
if (COMMAND_ERROR(command) == 0)
sema_wait(&sc->cmd_sema);
ips_insert_free_cmd(sc, command);
return 0;
}
int ips_ffdc_reset(ips_softc_t *sc)
{
ips_command_t *command;
if (ips_get_free_cmd(sc, &command, IPS_STATIC_FLAG)){
device_printf(sc->dev, "ERROR: unable to get a command! can't send ffdc reset!\n");
}
ips_send_ffdc_reset_cmd(command);
if(COMMAND_ERROR(command)){
device_printf(sc->dev, "ERROR: ffdc reset command failed!\n");
}
return 0;
}
static void ips_write_nvram(ips_command_t *command){
ips_softc_t *sc = command->sc;
ips_rw_nvram_cmd *command_struct;
ips_nvram_page5 *nvram;
/*FIXME check for error */
command->callback = ips_wakeup_callback;
command_struct = (ips_rw_nvram_cmd *)command->command_buffer;
command_struct->command = IPS_RW_NVRAM_CMD;
command_struct->id = command->id;
command_struct->pagenum = 5;
command_struct->rw = 1; /*write*/
bus_dmamap_sync(command->data_dmatag, command->data_dmamap,
BUS_DMASYNC_POSTREAD);
nvram = command->data_buffer;
/* retrieve adapter info and save in sc */
sc->adapter_type = nvram->adapter_type;
strncpy(nvram->driver_high, IPS_VERSION_MAJOR, 4);
strncpy(nvram->driver_low, IPS_VERSION_MINOR, 4);
nvram->operating_system = IPS_OS_FREEBSD;
bus_dmamap_sync(sc->command_dmatag, command->command_dmamap,
BUS_DMASYNC_PREWRITE);
sc->ips_issue_cmd(command);
}
static void ips_read_nvram_callback(void *cmdptr, bus_dma_segment_t *segments,int segnum, int error)
{
ips_softc_t *sc;
ips_command_t *command = cmdptr;
ips_rw_nvram_cmd *command_struct;
sc = command->sc;
if(error){
ips_set_error(command, error);
printf("ips: error = %d in ips_read_nvram_callback\n", error);
return;
}
command_struct = (ips_rw_nvram_cmd *)command->command_buffer;
command_struct->command = IPS_RW_NVRAM_CMD;
command_struct->id = command->id;
command_struct->pagenum = 5;
command_struct->rw = 0;
command_struct->buffaddr = segments[0].ds_addr;
bus_dmamap_sync(sc->command_dmatag, command->command_dmamap,
BUS_DMASYNC_PREWRITE);
bus_dmamap_sync(command->data_dmatag, command->data_dmamap,
BUS_DMASYNC_PREREAD);
sc->ips_issue_cmd(command);
if (sema_timedwait(&sc->cmd_sema, 30*hz) != 0) {
ips_set_error(command, ETIMEDOUT);
return;
}
bus_dmamap_sync(command->data_dmatag, command->data_dmamap,
BUS_DMASYNC_POSTWRITE);
}
static int ips_read_nvram(ips_command_t *command)
{
int error = 0;
ips_softc_t *sc = command->sc;
if (bus_dma_tag_create( /* parent */ sc->adapter_dmatag,
/* alignemnt */ 1,
/* boundary */ 0,
/* lowaddr */ BUS_SPACE_MAXADDR_32BIT,
/* highaddr */ BUS_SPACE_MAXADDR,
/* filter */ NULL,
/* filterarg */ NULL,
/* maxsize */ IPS_NVRAM_PAGE_SIZE,
/* numsegs */ 1,
/* maxsegsize*/ IPS_NVRAM_PAGE_SIZE,
/* flags */ 0,
/* lockfunc */ NULL,
/* lockarg */ NULL,
&command->data_dmatag) != 0) {
printf("ips: can't alloc dma tag for nvram\n");
error = ENOMEM;
goto exit;
}
if(bus_dmamem_alloc(command->data_dmatag, &command->data_buffer,
BUS_DMA_NOWAIT, &command->data_dmamap)){
error = ENOMEM;
goto exit;
}
command->callback = ips_write_nvram;
error = bus_dmamap_load(command->data_dmatag, command->data_dmamap,
command->data_buffer,IPS_NVRAM_PAGE_SIZE,
ips_read_nvram_callback, command,
BUS_DMA_NOWAIT);
if (error == 0)
bus_dmamap_unload(command->data_dmatag, command->data_dmamap);
exit:
bus_dmamem_free(command->data_dmatag, command->data_buffer,
command->data_dmamap);
bus_dma_tag_destroy(command->data_dmatag);
ips_insert_free_cmd(sc, command);
return error;
}
int ips_update_nvram(ips_softc_t *sc)
{
ips_command_t *command;
if (ips_get_free_cmd(sc, &command, IPS_STATIC_FLAG)){
device_printf(sc->dev, "ERROR: unable to get a command! can't update nvram\n");
return 1;
}
ips_read_nvram(command);
if(COMMAND_ERROR(command)){
device_printf(sc->dev, "ERROR: nvram update command failed!\n");
}
return 0;
}
static int ips_send_config_sync_cmd(ips_command_t *command)
{
ips_softc_t *sc = command->sc;
ips_generic_cmd *command_struct;
PRINTF(10,"ips test: got a command, building flush command\n");
command->callback = ips_wakeup_callback;
command_struct = (ips_generic_cmd *)command->command_buffer;
command_struct->command = IPS_CONFIG_SYNC_CMD;
command_struct->id = command->id;
command_struct->reserve2 = IPS_POCL;
bus_dmamap_sync(sc->command_dmatag, command->command_dmamap,
BUS_DMASYNC_PREWRITE);
sc->ips_issue_cmd(command);
if (COMMAND_ERROR(command) == 0)
sema_wait(&sc->cmd_sema);
ips_insert_free_cmd(sc, command);
return 0;
}
static int ips_send_error_table_cmd(ips_command_t *command)
{
ips_softc_t *sc = command->sc;
ips_generic_cmd *command_struct;
PRINTF(10,"ips test: got a command, building errortable command\n");
command->callback = ips_wakeup_callback;
command_struct = (ips_generic_cmd *)command->command_buffer;
command_struct->command = IPS_ERROR_TABLE_CMD;
command_struct->id = command->id;
command_struct->reserve2 = IPS_CSL;
bus_dmamap_sync(sc->command_dmatag, command->command_dmamap,
BUS_DMASYNC_PREWRITE);
sc->ips_issue_cmd(command);
if (COMMAND_ERROR(command) == 0)
sema_wait(&sc->cmd_sema);
ips_insert_free_cmd(sc, command);
return 0;
}
int ips_clear_adapter(ips_softc_t *sc)
{
ips_command_t *command;
device_printf(sc->dev, "syncing config\n");
if (ips_get_free_cmd(sc, &command, IPS_STATIC_FLAG)){
device_printf(sc->dev, "ERROR: unable to get a command! can't sync cache!\n");
return 1;
}
ips_send_config_sync_cmd(command);
if(COMMAND_ERROR(command)){
device_printf(sc->dev, "ERROR: cache sync command failed!\n");
return 1;
}
device_printf(sc->dev, "clearing error table\n");
if(ips_get_free_cmd(sc, &command, IPS_STATIC_FLAG)){
device_printf(sc->dev, "ERROR: unable to get a command! can't sync cache!\n");
return 1;
}
ips_send_error_table_cmd(command);
if(COMMAND_ERROR(command)){
device_printf(sc->dev, "ERROR: etable command failed!\n");
return 1;
}
return 0;
}