Attachment 19356 Details for Bug 15346 – probe-modem-licensed.c

probe-modem-licensed.c

probe-modem-licensed.c (text/plain), 4.40 KB, created by Antti Kaijanmäki on 2008-10-03 12:28:48 UTC

(hide)

Description:

Filename:

MIME Type:

Creator: Antti Kaijanmäki

Created: 2008-10-03 12:28:48 UTC

Size: 4.40 KB

patch

obsolete

>/* -*- Mode: C; indent-tabs-mode: t; c-basic-offset: 8; tab-width: 8 -*- */
>/* Probe modem capabilities
> *
> * Copyright (c) 2008 Vitja Makarov, <vitja.makarov@gmail.com>
> *
> * 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.
> *
> * This program 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 General Public License for more details.
> *
> * You should have received a copy of the GNU General Public License
> * along with this program; if not, write to the Free Software
> * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
> *
> */
>
>#ifdef HAVE_CONFIG_H
># include <config.h>
>#endif
>
>#include <termios.h>
>#include <unistd.h>
>#include <fcntl.h>
>#include <errno.h>
>
>#include <stdio.h>
>#include <string.h>
>#include <stdlib.h>
>
>#include "libhal/libhal.h"
>#include "../../logger.h"
>
>#define MODEM_CAP_GSM         0x0001 /* GSM commands */
>#define MODEM_CAP_IS707_A     0x0002 /* CDMA circuit switched data commands */
>#define MODEM_CAP_DS          0x0004 /* data compression */
>#define MODEM_CAP_ES          0x0008 /* error control */
>#define MODEM_CAP_FCLASS      0x0010 /* Fax commands */
>#define MODEM_CAP_MS          0x0020 /* Modulation control commands */
>#define MODEM_CAP_W           0x0040 /* Wireless commands */      
>
>struct modem_caps {
>	char *name;
>	int bits;
>};
>
>static struct modem_caps modem_caps[] = {
>	{"+CGSM",     MODEM_CAP_GSM},
>	/* TODO: are they the same? */
>	{"+CIS707-A", MODEM_CAP_IS707_A},
>	{"+CIS707",   MODEM_CAP_IS707_A},
>	{"+CIS707P",   MODEM_CAP_IS707_A},
>	{NULL}
>} ;
>
>#define AT_CAPS_PROBE "AT+GCAP\r\n"
>
>static int modem_probe_caps(int fd)
>{
>	char buf[200];
>	char *ptr, *field = NULL;
>	int err, ret = 0;
>
>	err = write(fd, AT_CAPS_PROBE, sizeof(AT_CAPS_PROBE) - 1);
>    
>	if (err != sizeof(AT_CAPS_PROBE) - 1)
>		return -1;
>
>	/* 100ms is enough for modem to send all the data */
>	usleep(100000);
>
>	err = read(fd, buf, sizeof(buf) - 1);
>	if (err <= 0)
>		return -1;
>	buf[err] = 0;
>
>	/* check okay reply */
>	ptr = strstr(buf, "\r\nOK\r\n");
>	if (!ptr)
>		return -1;
>	*ptr = 0;
>
>	/* find +GCAP: string */
>	ptr = strstr(buf, "\r\n+GCAP:");
>    
>	if (ptr == NULL)
>		return -1;
>	ptr += 8;
>
>	/* and parse it */
>	do {
>		err = *ptr == '\0' || *ptr == '\r' || *ptr == '\n';
>		if (*ptr == ' ' || *ptr == ',' || err) {
>			*ptr = 0;
>			if (field) {
>				struct modem_caps *cap = modem_caps;
>
>				while (cap->name) {
>					if (!strcmp(cap->name, field))
>						ret |= cap->bits;
>					cap++;
>				}
>			}
>			field = NULL;
>		} else if (NULL == field) {
>			field = ptr;
>		}
>		ptr++;
>	} while (!err);
>
>	return ret;
>}
>
>int main(int argc, char *argv[])
>{
>	struct termios orig, attrs;
>	DBusError error;
>	LibHalContext *ctx;
>	char *udi;
>	char *device;
>	int fd, caps;
>
>	setup_logger();
>
>	if ((udi = getenv("UDI")) == NULL) {
>		HAL_ERROR(("UDI is not set"));
>		return -1;
>	}
>	
>	if ((device = getenv("HAL_PROP_SERIAL_DEVICE")) == NULL) {
>		HAL_ERROR(("HAL_PROP_SERIAL_DEVICE is not set"));
>		return -1;
>	}
>
>	fd = open(device, O_RDWR|O_NDELAY);
>
>	if (-1 == fd) {
>		HAL_ERROR(("open(%s): %s", device, strerror(errno)));
>		return -1;
>	}
>
>	if (tcgetattr(fd, &orig))
>		return -1;
>	
>	memcpy(&attrs, &orig, sizeof(attrs));
>	attrs.c_iflag &= ~(IGNCR | ICRNL | IUCLC | INPCK | IXON | IXANY | IGNPAR);
>	attrs.c_oflag &= ~(OPOST | OLCUC | OCRNL | ONLCR | ONLRET);
>	attrs.c_lflag &= ~(ICANON | XCASE | ECHO | ECHOE | ECHONL);
>	attrs.c_lflag &= ~(ECHO | ECHOE);
>	attrs.c_cc[VMIN] = 1;
>	attrs.c_cc[VTIME] = 0;
>	attrs.c_cc[VEOF] = 1;
>	
>	tcsetattr(fd, TCSANOW, &attrs);
>	caps = modem_probe_caps(fd);
>	tcsetattr(fd, TCSANOW, &orig);
>
>	if (caps < 0) {
>		HAL_ERROR(("Couldn't get caps"));
>		return -1;
>	}
>	
>	dbus_error_init (&error);
>
>	if ((ctx = libhal_ctx_init_direct(&error)) == NULL) {
>		HAL_ERROR(("ctx init failed"));
>		return -1;
>	}
>
>	if (caps & MODEM_CAP_GSM) {
>		HAL_DEBUG(("Found GSM modem"));
>		libhal_device_property_strlist_append(ctx, udi, "modem.command_sets", "GSM-07.07", NULL);
>		libhal_device_property_strlist_append(ctx, udi, "modem.command_sets", "GSM-07.05", NULL);
>	}
>	
>	if (caps & MODEM_CAP_IS707_A) {
>		HAL_DEBUG(("Found CDMA modem"));
>		libhal_device_property_strlist_append(ctx, udi, "modem.command_sets", "IS-707-A", NULL);
>	}
>	
>	return 0;
>}

Actions: View

Attachments on bug 15346: 16091 | 16380 | 16381 | 19356

Use of freedesktop.org services, including Bugzilla, is subject to our Code of Conduct. How we collect and use information is described in our Privacy Policy.