Diffstat (limited to 'noncore/net/opietooth/lib/bt-serial.c') (more/less context) (ignore whitespace changes)
-rw-r--r-- | noncore/net/opietooth/lib/bt-serial.c | 308 |
1 files changed, 308 insertions, 0 deletions
diff --git a/noncore/net/opietooth/lib/bt-serial.c b/noncore/net/opietooth/lib/bt-serial.c new file mode 100644 index 0000000..d1a65a2 --- a/dev/null +++ b/noncore/net/opietooth/lib/bt-serial.c @@ -0,0 +1,308 @@ +/* $Id$ + * Bluetooth serial forwarder functions implementation + * + * (c) Copyright 2006 GPL + * + * This software is provided under the GNU public license, incorporated + * herein by reference. The software is provided without warranty or + * support. + */ +#include "bt-serial.h" +#include <errno.h> +#include <unistd.h> +#include <sys/time.h> +#include <sys/types.h> +#include <sys/socket.h> +#include <bluetooth/bluetooth.h> +#include <bluetooth/rfcomm.h> +#include <bluetooth/sdp.h> +#include <bluetooth/sdp_lib.h> +#include <termios.h> +#include <sys/stat.h> +#include <fcntl.h> +#include <stdio.h> + +static int hserv = -1; //Server socket +sdp_session_t* session = NULL; //session with an SDP server + +static sdp_session_t* register_service(uint8_t rfchannel) +{ + int err = 0; + sdp_profile_desc_t profile[1]; + uint32_t service_uuid_int[] = { 0, 0, 0, 0xABCD }; + const char *service_name = "Serial forwarder"; + const char *service_dsc = "Serial forwarder"; + const char *service_prov = "OPIE team"; + uuid_t root_uuid, l2cap_uuid, rfcomm_uuid, svc_uuid, service_uuid; + sdp_list_t* l2cap_list = 0; + sdp_list_t* rfcomm_list = 0; + sdp_list_t* root_list = 0; + sdp_list_t* proto_list = 0; + sdp_list_t* access_proto_list = 0; + sdp_list_t* profile_list = 0; + sdp_list_t* service_list = 0; + sdp_data_t* channel = 0; + sdp_record_t* record = sdp_record_alloc(); + sdp_session_t* lsession = 0; + + // set the general service ID + sdp_uuid128_create(&svc_uuid, &service_uuid_int); + sdp_set_service_id(record, svc_uuid); + // make the service record publicly browsable + sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP); + root_list = sdp_list_append(0, &root_uuid); + sdp_set_browse_groups( record, root_list ); + + // set l2cap information + sdp_uuid16_create(&l2cap_uuid, L2CAP_UUID); + l2cap_list = sdp_list_append( 0, &l2cap_uuid ); + proto_list = sdp_list_append( 0, l2cap_list ); + + // set rfcomm information + sdp_uuid16_create(&rfcomm_uuid, RFCOMM_UUID); + channel = sdp_data_alloc(SDP_UINT8, &rfchannel); + rfcomm_list = sdp_list_append( 0, &rfcomm_uuid ); + sdp_list_append( rfcomm_list, channel ); + sdp_list_append( proto_list, rfcomm_list ); + + // attach protocol information to service record + access_proto_list = sdp_list_append( 0, proto_list ); + sdp_set_access_protos( record, access_proto_list ); + + sdp_uuid16_create(&service_uuid, SERIAL_PORT_SVCLASS_ID); + service_list = sdp_list_append( 0, &service_uuid ); + sdp_set_service_classes(record, service_list); + + profile[0].version = 0x0100; + sdp_uuid16_create(&profile[0].uuid, SERIAL_PORT_PROFILE_ID); + profile_list = sdp_list_append(0, &profile[0]); + sdp_set_profile_descs(record, profile_list); + + // set the name, provider, and description + sdp_set_info_attr(record, service_name, service_prov, service_dsc); + + // connect to the local SDP server, register the service record, and + // disconnect + lsession = sdp_connect(BDADDR_ANY, BDADDR_LOCAL, SDP_RETRY_IF_BUSY); + if (lsession == NULL) + goto errout; + err = sdp_record_register(lsession, record, 0); + if (err) { + sdp_close(lsession); + lsession = NULL; + } +errout: + // cleanup + sdp_data_free( channel ); + sdp_list_free( l2cap_list, 0 ); + sdp_list_free( rfcomm_list, 0 ); + sdp_list_free( root_list, 0 ); + sdp_list_free( access_proto_list, 0 ); + sdp_list_free( profile_list, 0 ); + sdp_list_free( service_list, 0 ); + + return lsession; +} + +/* + * Function opens and configures serial port + * portName - name of the serial port + * return 0 on success, -1 on error + */ +int openSerial(const char* portName) +{ + struct termios tc; //port attributes + int hserial = -1; //serial port handler + int result; //function call result + if ((hserial = open(portName, O_RDWR)) < 0) + goto errout; + if ((result = tcgetattr(hserial, &tc)) < 0) + goto errout; + cfmakeraw(&tc); + cfsetispeed(&tc, B9600); + cfsetospeed(&tc, B9600); + if ((result = tcsetattr(hserial, TCSANOW, &tc)) < 0) + goto errout; + if (result == 0) + errno = 0; +errout: + if (errno) { + if (hserial >= 0) { + close(hserial); + hserial = -1; + } + } + return hserial; +} + +/* + * bt_serialStart + * Function starts bt-serial service + * return 0 success -1 on error + */ +int bt_serialStart(void) +{ + struct sockaddr_rc loc_addr; //server address + int i; //just an index variable + int result = 0; //function call result + if (hserv >= 0) + return 0; + hserv = socket(AF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM); + // bind socket to port 1 of the first available + // local bluetooth adapter + memset(&loc_addr, 0, sizeof(struct sockaddr_rc)); + loc_addr.rc_family = AF_BLUETOOTH; + loc_addr.rc_bdaddr = *BDADDR_ANY; + for (i = 1; i < 32; i++) { + loc_addr.rc_channel = (uint8_t)i; + if (!(result = bind(hserv, + (struct sockaddr *)&loc_addr, + sizeof(loc_addr))) || errno == EINVAL) { + break; + } + } + if (result != 0) + goto errout; + else + errno = 0; + if (listen(hserv, 1) < 0) + goto errout; + session = register_service(loc_addr.rc_channel); +errout: + if (errno) { + result = errno; + close(hserv); + hserv = -1; + if (session != NULL) + sdp_close(session); + errno = result; + result = -1; + } + return result; +} + +/* + * bt_serialStop + * Function stops bt-serial service + * return device handler on success -1 on error + */ +int bt_serialStop(void) +{ + int result = 0; //Function call result + + if (hserv >= 0) { + result = close(hserv); + hserv = -1; + if (session != NULL) + sdp_close(session); + } + return result; +} + +/* + * btWrite + * hbt - handler of the BT connection + * buf - buffer to write + * plen - total length to write (and zero it!!!) + * return number of bytes written on success or -1 + */ +int btWrite(int hbt, uint8_t* buf, int* plen) +{ + int result; //Function call result + const suseconds_t writeDelay = 100000L; //wait after writing + result = write(hbt, buf, *plen); +#ifdef _DEBUG_ + printf("ser->bt %d\n", *plen); +#endif + *plen = 0; + usleep(writeDelay); + return result; +} + +/* + * bt_serialForward + * Function forwards data received from bt-connection to serial and backward + * conn - connection handler + * portName - name of the serial port to open + * return 0 success -1 on error + */ +/* + * This function has a hack. My BT adapter hangs if you try to write small + * portions of data to it to often. That's why we either wait for big enough + * (> wrThresh) portion of data from a serial port and write it to BT or + * wait for a timeout (tv). + */ +int bt_serialForward(BTSerialConn* conn, const char* portName) +{ + int result; //Function call result + fd_set inSet; //Set we scan for input + uint8_t inBuf[1500]; //buffer we read and write + uint8_t outBuf[1500]; //buffer we read and write + int outBytes; //bytes to be written to bt + int nbytes = 0; //number of bytes we could read + int maxfd; //maximal filehandler + struct timeval tv; //time we shall wait for select + const int wrThresh = 250; //threshold after which we send packet to bt + const suseconds_t waitDelay = 200000L; //Time (us) we wait for data + struct sockaddr_rc rem_addr; //client address + int len = sizeof(rem_addr); //argument length + + if (conn == NULL) { + errno = EINVAL; + return -1; + } + memset(&rem_addr, 0, sizeof(struct sockaddr_rc)); + conn->bt_handler = -1; + conn->ser_handler = -1; + conn->bt_handler = accept(hserv, (struct sockaddr *)&rem_addr, &len); + if (conn->bt_handler < 0) + return -1; + conn->ser_handler = openSerial(portName); + if (conn->ser_handler < 0) + return -1; +#ifdef _DEBUG_ + printf("Connect!\n"); +#endif + + FD_ZERO(&inSet); + maxfd = (conn->bt_handler > conn->ser_handler)? conn->bt_handler: + conn->ser_handler; + outBytes = 0; + do { + FD_SET(conn->bt_handler, &inSet); + FD_SET(conn->ser_handler, &inSet); + tv.tv_sec = 0; + tv.tv_usec = waitDelay; + result = select(maxfd + 1, &inSet, NULL, NULL, &tv); + if (result > 0) { + if (FD_ISSET(conn->bt_handler, &inSet)) { + if ((nbytes = read(conn->bt_handler, inBuf, sizeof(inBuf))) > 0) + result = write(conn->ser_handler, inBuf, nbytes); +#ifdef _DEBUG_ + printf("bt->ser %d\n", nbytes); +#endif + } + if (FD_ISSET(conn->ser_handler, &inSet)) { + if ((nbytes = read(conn->ser_handler, + outBuf + outBytes, sizeof(outBuf) - outBytes)) > 0) { + outBytes += nbytes; + if (outBytes > wrThresh) + result = btWrite(conn->bt_handler, outBuf, &outBytes); + } + } + } else if (result == 0) { + if (outBytes > 0) + result = btWrite(conn->bt_handler, outBuf, &outBytes); + } + } while (result == 0 || (result > 0 && nbytes > 0)); + if (nbytes <= 0) + result = -1; + close(conn->bt_handler); + close(conn->ser_handler); +#ifdef _DEBUG_ + printf("Disconnect!\n"); +#endif + return 0; +} + +//eof |