59 lines
1.8 KiB
C
59 lines
1.8 KiB
C
/* *****************************************************************************
|
|
* misc/setlink.c -- set link settings.
|
|
* Copyright (C) 2016-2017 Thomas "Cakeisalie5" Touhey <thomas@touhey.fr>
|
|
*
|
|
* This file is part of libp7.
|
|
* libp7 is free software; you can redistribute it and/or modify it
|
|
* under the terms of the GNU Lesser General Public License as published by
|
|
* the Free Software Foundation; either version 3.0 of the License,
|
|
* or (at your option) any later version.
|
|
*
|
|
* libp7 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 Lesser General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Lesser General Public License
|
|
* along with libp7; if not, see <http://www.gnu.org/licenses/>.
|
|
* ************************************************************************** */
|
|
#include <libp7/internals.h>
|
|
#include <libp7/internals/sleep.h>
|
|
|
|
/**
|
|
* p7_setlink:
|
|
* Set link settings.
|
|
*
|
|
* @arg handle the libp7 handle.
|
|
* @arg baudrate the speed.
|
|
* @arg parity the parity.
|
|
* @arg stopbits the number stop bits.
|
|
* @return the error code.
|
|
*/
|
|
|
|
int p7_setlink(p7_handle_t *handle, int baudrate, int parity, int stopbits)
|
|
{
|
|
int err;
|
|
|
|
/* make checks */
|
|
chk_handle(handle);
|
|
chk_active(handle);
|
|
|
|
/* send command */
|
|
log_info("sending command");
|
|
if ((err = p7_send_cmdsys_setlink(handle, baudrate, parity, stopbits))) {
|
|
log_fatal("could not set command/receive answer");
|
|
return (err);
|
|
} else if (response.type != p7_pt_ack) {
|
|
err = p7_error_unknown;
|
|
goto end;
|
|
}
|
|
|
|
/* set communication properties */
|
|
p7_setcomm(handle->_stream, baudrate, parity, stopbits);
|
|
|
|
end:
|
|
/* wait for the calculator to set its serial interface, and we're done */
|
|
p7_sleep(100);
|
|
return (0);
|
|
}
|