1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126
|
/***************************************************************************
lib/ibClr.c
-------------------
copyright : (C) 2001,2002 by Frank Mori Hess
email : fmhess@users.sourceforge.net
***************************************************************************/
/***************************************************************************
* *
* 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 of the License, or *
* (at your option) any later version. *
* *
***************************************************************************/
#include "ib_internal.h"
#include <stdlib.h>
int ibclr(int ud)
{
uint8_t cmd[ 16 ];
ibConf_t *conf;
ssize_t count;
int i;
conf = enter_library(ud);
if (conf == NULL)
return exit_library(ud, 1);
if (conf->is_interface) {
setIberr(EARG);
return exit_library(ud, 1);
}
i = send_setup_string(conf, cmd);
cmd[i++] = SDC;
//XXX detect no listeners (EBUS) error
count = my_ibcmd(conf, conf->settings.usec_timeout, cmd, i);
if (count != i)
return exit_library(ud, 1);
return exit_library(ud, 0);
}
int InternalDevClearList(ibConf_t *conf, const Addr4882_t addressList[])
{
int i;
ibBoard_t *board;
uint8_t *cmd;
int count;
int retval;
if (addressListIsValid(addressList) == 0)
return -1;
if (conf->is_interface == 0) {
setIberr(EDVR);
return -1;
}
board = interfaceBoard(conf);
retval = is_cic(board);
if (retval <= 0) {
if (retval == 0)
setIberr(ECIC);
return -1;
}
cmd = malloc(16 + 2 * numAddresses(addressList));
if (cmd == NULL) {
setIberr(EDVR);
setIbcnt(ENOMEM);
return -1;
}
i = 0;
if (numAddresses(addressList)) {
i += create_send_setup(board, addressList, cmd);
cmd[i++] = SDC;
} else {
cmd[ i++ ] = DCL;
}
//XXX detect no listeners (EBUS) error
count = my_ibcmd(conf, conf->settings.usec_timeout, cmd, i);
free(cmd);
cmd = NULL;
if (count != i)
return -1;
return 0;
}
void DevClearList(int boardID, const Addr4882_t addressList[])
{
int retval;
ibConf_t *conf;
conf = enter_library(boardID);
if (conf == NULL) {
exit_library(boardID, 1);
return;
}
retval = InternalDevClearList(conf, addressList);
if (retval < 0)
exit_library(boardID, 1);
exit_library(boardID, 0);
}
void DevClear(int boardID, Addr4882_t address)
{
Addr4882_t addressList[2];
addressList[0] = address;
addressList[1] = NOADDR;
DevClearList(boardID, addressList);
}
|