| /****************************************************************************** |
| * |
| * Copyright (C) 2003-2012 Broadcom Corporation |
| * |
| * Licensed under the Apache License, Version 2.0 (the "License"); |
| * you may not use this file except in compliance with the License. |
| * You may obtain a copy of the License at: |
| * |
| * http://www.apache.org/licenses/LICENSE-2.0 |
| * |
| * Unless required by applicable law or agreed to in writing, software |
| * distributed under the License is distributed on an "AS IS" BASIS, |
| * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| * See the License for the specific language governing permissions and |
| * limitations under the License. |
| * |
| ******************************************************************************/ |
| |
| /****************************************************************************** |
| * |
| * This file contains utility functions. |
| * |
| ******************************************************************************/ |
| #include <stddef.h> |
| #include "utl.h" |
| #include "bt_common.h" |
| #include "btm_api.h" |
| |
| /******************************************************************************* |
| * |
| * Function utl_str2int |
| * |
| * Description This utility function converts a character string to an |
| * integer. Acceptable values in string are 0-9. If invalid |
| * string or string value too large, -1 is returned. Leading |
| * spaces are skipped. |
| * |
| * |
| * Returns Integer value or -1 on error. |
| * |
| ******************************************************************************/ |
| int16_t utl_str2int(const char *p_s) |
| { |
| int32_t val = 0; |
| |
| for (;*p_s == ' ' && *p_s != 0; p_s++); |
| |
| if (*p_s == 0) return -1; |
| |
| for (;;) |
| { |
| if ((*p_s < '0') || (*p_s > '9')) return -1; |
| |
| val += (int32_t) (*p_s++ - '0'); |
| |
| if (val > 32767) return -1; |
| |
| if (*p_s == 0) |
| { |
| return (int16_t) val; |
| } |
| else |
| { |
| val *= 10; |
| } |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function utl_strucmp |
| * |
| * Description This utility function compares two strings in uppercase. |
| * String p_s must be uppercase. String p_t is converted to |
| * uppercase if lowercase. If p_s ends first, the substring |
| * match is counted as a match. |
| * |
| * |
| * Returns 0 if strings match, nonzero otherwise. |
| * |
| ******************************************************************************/ |
| int utl_strucmp(const char *p_s, const char *p_t) |
| { |
| char c; |
| |
| while (*p_s && *p_t) |
| { |
| c = *p_t++; |
| if (c >= 'a' && c <= 'z') |
| { |
| c -= 0x20; |
| } |
| if (*p_s++ != c) |
| { |
| return -1; |
| } |
| } |
| /* if p_t hit null first, no match */ |
| if (*p_t == 0 && *p_s != 0) |
| { |
| return 1; |
| } |
| /* else p_s hit null first, count as match */ |
| else |
| { |
| return 0; |
| } |
| } |
| |
| /******************************************************************************* |
| * |
| * Function utl_itoa |
| * |
| * Description This utility function converts a uint16_t to a string. The |
| * string is NULL-terminated. The length of the string is |
| * returned; |
| * |
| * |
| * Returns Length of string. |
| * |
| ******************************************************************************/ |
| uint8_t utl_itoa(uint16_t i, char *p_s) |
| { |
| uint16_t j, k; |
| char *p = p_s; |
| bool fill = false; |
| |
| if (i == 0) |
| { |
| /* take care of zero case */ |
| *p++ = '0'; |
| } |
| else |
| { |
| for(j = 10000; j > 0; j /= 10) |
| { |
| k = i / j; |
| i %= j; |
| if (k > 0 || fill) |
| { |
| *p++ = k + '0'; |
| fill = true; |
| } |
| } |
| } |
| *p = 0; |
| return (uint8_t) (p - p_s); |
| } |
| |
| /******************************************************************************* |
| * |
| * Function utl_set_device_class |
| * |
| * Description This function updates the local Device Class. |
| * |
| * Parameters: |
| * p_cod - Pointer to the device class to set to |
| * |
| * cmd - the fields of the device class to update. |
| * BTA_UTL_SET_COD_MAJOR_MINOR, - overwrite major, minor class |
| * BTA_UTL_SET_COD_SERVICE_CLASS - set the bits in the input |
| * BTA_UTL_CLR_COD_SERVICE_CLASS - clear the bits in the input |
| * BTA_UTL_SET_COD_ALL - overwrite major, minor, set the bits in service class |
| * BTA_UTL_INIT_COD - overwrite major, minor, and service class |
| * |
| * Returns true if successful, Otherwise false |
| * |
| ******************************************************************************/ |
| bool utl_set_device_class(tBTA_UTL_COD *p_cod, uint8_t cmd) |
| { |
| uint8_t *dev; |
| uint16_t service; |
| uint8_t minor, major; |
| DEV_CLASS dev_class; |
| |
| dev = BTM_ReadDeviceClass(); |
| BTM_COD_SERVICE_CLASS( service, dev ); |
| BTM_COD_MINOR_CLASS(minor, dev ); |
| BTM_COD_MAJOR_CLASS(major, dev ); |
| |
| switch(cmd) |
| { |
| case BTA_UTL_SET_COD_MAJOR_MINOR: |
| minor = p_cod->minor & BTM_COD_MINOR_CLASS_MASK; |
| major = p_cod->major & BTM_COD_MAJOR_CLASS_MASK; |
| break; |
| |
| case BTA_UTL_SET_COD_SERVICE_CLASS: |
| /* clear out the bits that is not SERVICE_CLASS bits */ |
| p_cod->service &= BTM_COD_SERVICE_CLASS_MASK; |
| service = service | p_cod->service; |
| break; |
| |
| case BTA_UTL_CLR_COD_SERVICE_CLASS: |
| p_cod->service &= BTM_COD_SERVICE_CLASS_MASK; |
| service = service & (~p_cod->service); |
| break; |
| |
| case BTA_UTL_SET_COD_ALL: |
| minor = p_cod->minor & BTM_COD_MINOR_CLASS_MASK; |
| major = p_cod->major & BTM_COD_MAJOR_CLASS_MASK; |
| p_cod->service &= BTM_COD_SERVICE_CLASS_MASK; |
| service = service | p_cod->service; |
| break; |
| |
| case BTA_UTL_INIT_COD: |
| minor = p_cod->minor & BTM_COD_MINOR_CLASS_MASK; |
| major = p_cod->major & BTM_COD_MAJOR_CLASS_MASK; |
| service = p_cod->service & BTM_COD_SERVICE_CLASS_MASK; |
| break; |
| |
| default: |
| return false; |
| } |
| |
| /* convert the fields into the device class type */ |
| FIELDS_TO_COD(dev_class, minor, major, service); |
| |
| if (BTM_SetDeviceClass(dev_class) == BTM_SUCCESS) |
| return true; |
| |
| return false; |
| } |
| |
| /******************************************************************************* |
| * |
| * Function utl_isintstr |
| * |
| * Description This utility function checks if the given string is an |
| * integer string or not |
| * |
| * |
| * Returns true if successful, Otherwise false |
| * |
| ******************************************************************************/ |
| bool utl_isintstr(const char *p_s) |
| { |
| uint16_t i = 0; |
| |
| for(i=0; p_s[i] != 0; i++) |
| { |
| if(((p_s[i] < '0') || (p_s[i] > '9')) && (p_s[i] != ';')) |
| return false; |
| } |
| |
| return true; |
| } |
| |
| /******************************************************************************* |
| * |
| * Function utl_isdialchar |
| * |
| * Description This utility function checks if the given character |
| * is an acceptable dial digit |
| * |
| * Returns true if successful, Otherwise false |
| * |
| ******************************************************************************/ |
| bool utl_isdialchar(const char d) |
| { |
| return (((d >= '0') && (d <= '9')) |
| || (d == '*') || (d == '+') || (d == '#') || (d == ';') |
| || ((d >= 'A') && (d <= 'C')) |
| || ((d == 'p') || (d == 'P') |
| || (d == 'w') || (d == 'W'))); |
| } |
| |
| /******************************************************************************* |
| * |
| * Function utl_isdialstr |
| * |
| * Description This utility function checks if the given string contains |
| * only dial digits or not |
| * |
| * |
| * Returns true if successful, Otherwise false |
| * |
| ******************************************************************************/ |
| bool utl_isdialstr(const char *p_s) |
| { |
| for (uint16_t i = 0; p_s[i] != 0; i++) { |
| // include chars not in spec that work sent by some headsets. |
| if(!(utl_isdialchar(p_s[i]) |
| || (p_s[i] == '-'))) |
| return false; |
| } |
| return true; |
| } |
| |
| |