bool QRS232::open(QString & port, enum rs232_baud_e baud)
{
m_port = rs232_init();
rs232_set_device(m_port, port.toLatin1().data());
rs232_set_baud(m_port, baud);
unsigned int ret = rs232_open(m_port);
if (ret == RS232_ERR_NOERROR) {
m_open = true;
return true;
}
return false;
}
unsigned int rs232_simple_test(void)
{
unsigned int try = 0;
unsigned int bytes = 0;
unsigned char data[1];
unsigned int ret = 0;
struct rs232_port_t *p = NULL;
p = rs232_init();
if (p == NULL)
return 1;
#ifdef WIN32
rs232_set_device(p, "COM1");
#else
rs232_set_device(p, "/dev/ttyS1");
#endif
ret = rs232_open(p);
if (ret) {
rs232_end(p);
return err(ret);
}
rs232_set_baud(p, RS232_BAUD_115200);
printf("[*] port settings: %s\n", rs232_to_string(p));
rs232_flush(p);
while (try++ < 10) {
printf("%02d. [*] read: ", try);
data[0] = 0x00;
ret = rs232_read_timeout(p, data, 1, &bytes, 1000);
if (ret)
err(ret);
else
printf("0x%02x len: %d\n", data[0], bytes);
data[0] = 0x05;
bytes = 0;
printf("%02d. [*] write: ", try);
ret = rs232_write_timeout(p, data, 1, &bytes, 1000);
if (ret)
err(ret);
else
printf("len: %d\n", bytes);
}
rs232_end(p);
return 0;
}
RS232_LIB unsigned int
rs232_open(struct rs232_port_t *p)
{
wchar_t *wname = a2w(fix_device_name(p->dev));
struct rs232_windows_t *wx = p->pt;
DBG("p=%p p->pt=%p name='%s' fix='%s'\n",
(void *)p, p->pt, p->dev, fix_device_name(p->dev));
if (wname == NULL)
return RS232_ERR_UNKNOWN;
wx->fd = CreateFile(wname, GENERIC_READ | GENERIC_WRITE,
FILE_SHARE_READ | FILE_SHARE_WRITE,
NULL, OPEN_EXISTING, 0, NULL);
if (wname)
free(wname);
if (wx->fd == INVALID_HANDLE_VALUE) {
DBG("CreateFile() %s\n", last_error());
return RS232_ERR_OPEN;
}
p->status = RS232_PORT_OPEN;
rs232_flush(p);
GET_PORT_STATE(wx->fd, &wx->old_dcb);
GET_PORT_TIMEOUTS(wx->fd, &wx->old_tm);
port_timeout(p, wx->r_timeout, wx->w_timeout);
port_buffers(p, wx->r_buffer, wx->w_buffer);
rs232_set_baud(p, p->baud);
rs232_set_data(p, p->data);
rs232_set_parity(p, p->parity);
rs232_set_stop(p, p->stop);
rs232_set_flow(p, p->flow);
return RS232_ERR_NOERROR;
}
static int init_serial(void)
{
unsigned int ret = 0;
port = rs232_init();
if (port == NULL) return 1;
rs232_set_device(port, portname);
ret = rs232_open(port); // open port
if (ret)
{
printf("%s (%s)\n", rs232_strerror(ret), errno > 0 ? strerror(errno) : "");
return ret;
}
rs232_set_baud(port, RS232_BAUD_115200);
rs232_flush(port);
// wait for arduino init
sleep(3);
return 0;
}
