initial

libPDU.cpp

@@ -0,0 +1,499 @@
+#include "libPDU.h"
+#include "Arduino.h"
+#include "WProgram.h"
+
+
+char lookup_ascii8to7[]= {
+    NPC7,       /*     0      null [NUL]                              */
+    NPC7,       /*     1      start of heading [SOH]                  */
+    NPC7,       /*     2      start of text [STX]                     */
+    NPC7,       /*     3      end of text [ETX]                       */
+    NPC7,       /*     4      end of transmission [EOT]               */
+    NPC7,       /*     5      enquiry [ENQ]                           */
+    NPC7,       /*     6      acknowledge [ACK]                       */
+    NPC7,       /*     7      bell [BEL]                              */
+    NPC7,       /*     8      backspace [BS]                          */
+    NPC7,       /*     9      horizontal tab [HT]                     */
+    10,         /*    10      line feed [LF]                          */
+    NPC7,       /*    11      vertical tab [VT]                       */
+    10+256,     /*    12      form feed [FF]                          */
+    13,         /*    13      carriage return [CR]                    */
+    NPC7,       /*    14      shift out [SO]                          */
+    NPC7,       /*    15      shift in [SI]                           */
+    NPC7,       /*    16      data link escape [DLE]                  */
+    NPC7,       /*    17      device control 1 [DC1]                  */
+    NPC7,       /*    18      device control 2 [DC2]                  */
+    NPC7,       /*    19      device control 3 [DC3]                  */
+    NPC7,       /*    20      device control 4 [DC4]                  */
+    NPC7,       /*    21      negative acknowledge [NAK]              */
+    NPC7,       /*    22      synchronous idle [SYN]                  */
+    NPC7,       /*    23      end of trans. block [ETB]               */
+    NPC7,       /*    24      cancel [CAN]                            */
+    NPC7,       /*    25      end of medium [EM]                      */
+    NPC7,       /*    26      substitute [SUB]                        */
+    NPC7,       /*    27      escape [ESC]                            */
+    NPC7,       /*    28      file separator [FS]                     */
+    NPC7,       /*    29      group separator [GS]                    */
+    NPC7,       /*    30      record separator [RS]                   */
+    NPC7,       /*    31      unit separator [US]                     */
+    32,         /*    32      space                                   */
+    33,         /*    33    ! exclamation mark                        */
+    34,         /*    34    " double quotation mark                   */
+    35,         /*    35    # number sign                             */
+    2,          /*    36    $ dollar sign                             */
+    37,         /*    37    % percent sign                            */
+    38,         /*    38    & ampersand                               */
+    39,         /*    39    ' apostrophe                              */
+    40,         /*    40    ( left parenthesis                        */
+    41,         /*    41    ) right parenthesis                       */
+    42,         /*    42    * asterisk                                */
+    43,         /*    43    + plus sign                               */
+    44,         /*    44    , comma                                   */
+    45,         /*    45    - hyphen                                  */
+    46,         /*    46    . period                                  */
+    47,         /*    47    / slash,                                  */
+    48,         /*    48    0 digit 0                                 */
+    49,         /*    49    1 digit 1                                 */
+    50,         /*    50    2 digit 2                                 */
+    51,         /*    51    3 digit 3                                 */
+    52,         /*    52    4 digit 4                                 */
+    53,         /*    53    5 digit 5                                 */
+    54,         /*    54    6 digit 6                                 */
+    55,         /*    55    7 digit 7                                 */
+    56,         /*    56    8 digit 8                                 */
+    57,         /*    57    9 digit 9                                 */
+    58,         /*    58    : colon                                   */
+    59,         /*    59    ; semicolon                               */
+    60,         /*    60    < less-than sign                          */
+    61,         /*    61    = equal sign                              */
+    62,         /*    62    > greater-than sign                       */
+    63,         /*    63    ? question mark                           */
+    0,          /*    64    @ commercial at sign                      */
+    65,         /*    65    A uppercase A                             */
+    66,         /*    66    B uppercase B                             */
+    67,         /*    67    C uppercase C                             */
+    68,         /*    68    D uppercase D                             */
+    69,         /*    69    E uppercase E                             */
+    70,         /*    70    F uppercase F                             */
+    71,         /*    71    G uppercase G                             */
+    72,         /*    72    H uppercase H                             */
+    73,         /*    73    I uppercase I                             */
+    74,         /*    74    J uppercase J                             */
+    75,         /*    75    K uppercase K                             */
+    76,         /*    76    L uppercase L                             */
+    77,         /*    77    M uppercase M                             */
+    78,         /*    78    N uppercase N                             */
+    79,         /*    79    O uppercase O                             */
+    80,         /*    80    P uppercase P                             */
+    81,         /*    81    Q uppercase Q                             */
+    82,         /*    82    R uppercase R                             */
+    83,         /*    83    S uppercase S                             */
+    84,         /*    84    T uppercase T                             */
+    85,         /*    85    U uppercase U                             */
+    86,         /*    86    V uppercase V                             */
+    87,         /*    87    W uppercase W                             */
+    88,         /*    88    X uppercase X                             */
+    89,         /*    89    Y uppercase Y                             */
+    90,         /*    90    Z uppercase Z                             */
+    60+256,     /*    91    [ left square bracket                     */
+    47+256,     /*    92    \ backslash                               */
+    62+256,     /*    93    ] right square bracket                    */
+    20+256,     /*    94    ^ circumflex accent                       */
+    17,         /*    95    _ underscore                              */
+    -39,        /*    96    ` back apostrophe                         */
+    97,         /*    97    a lowercase a                             */
+    98,         /*    98    b lowercase b                             */
+    99,         /*    99    c lowercase c                             */
+    100,        /*   100    d lowercase d                             */
+    101,        /*   101    e lowercase e                             */
+    102,        /*   102    f lowercase f                             */
+    103,        /*   103    g lowercase g                             */
+    104,        /*   104    h lowercase h                             */
+    105,        /*   105    i lowercase i                             */
+    106,        /*   106    j lowercase j                             */
+    107,        /*   107    k lowercase k                             */
+    108,        /*   108    l lowercase l                             */
+    109,        /*   109    m lowercase m                             */
+    110,        /*   110    n lowercase n                             */
+    111,        /*   111    o lowercase o                             */
+    112,        /*   112    p lowercase p                             */
+    113,        /*   113    q lowercase q                             */
+    114,        /*   114    r lowercase r                             */
+    115,        /*   115    s lowercase s                             */
+    116,        /*   116    t lowercase t                             */
+    117,        /*   117    u lowercase u                             */
+    118,        /*   118    v lowercase v                             */
+    119,        /*   119    w lowercase w                             */
+    120,        /*   120    x lowercase x                             */
+    121,        /*   121    y lowercase y                             */
+    122,        /*   122    z lowercase z                             */
+    40+256,     /*   123    { left brace                              */
+    64+256,     /*   124    | vertical bar                            */
+    41+256,     /*   125    } right brace                             */
+    61+256,     /*   126    ~ tilde accent                            */
+    NPC7,       /*   127      delete [DEL]                            */
+    NPC7,       /*   128                                              */
+    NPC7,       /*   129                                              */
+    -39,        /*   130      low left rising single quote            */
+    -102,       /*   131      lowercase italic f                      */
+    -34,        /*   132      low left rising double quote            */
+    NPC7,       /*   133      low horizontal ellipsis                 */
+    NPC7,       /*   134      dagger mark                             */
+    NPC7,       /*   135      double dagger mark                      */
+    NPC7,       /*   136      letter modifying circumflex             */
+    NPC7,       /*   137      per thousand (mille) sign               */
+    -83,        /*   138      uppercase S caron or hacek              */
+    -39,        /*   139      left single angle quote mark            */
+    -214,       /*   140      uppercase OE ligature                   */
+    NPC7,       /*   141                                              */
+    NPC7,       /*   142                                              */
+    NPC7,       /*   143                                              */
+    NPC7,       /*   144                                              */
+    -39,        /*   145      left single quotation mark              */
+    -39,        /*   146      right single quote mark                 */
+    -34,        /*   147      left double quotation mark              */
+    -34,        /*   148      right double quote mark                 */
+    -42,        /*   149      round filled bullet                     */
+    -45,        /*   150      en dash                                 */
+    -45,        /*   151      em dash                                 */
+    -39,        /*   152      small spacing tilde accent              */
+    NPC7,       /*   153      trademark sign                          */
+    -115,       /*   154      lowercase s caron or hacek              */
+    -39,        /*   155      right single angle quote mark           */
+    -111,       /*   156      lowercase oe ligature                   */
+    NPC7,       /*   157                                              */
+    NPC7,       /*   158                                              */
+    -89,        /*   159      uppercase Y dieresis or umlaut          */
+    -32,        /*   160    ? non-breaking space                      */
+    64,         /*   161    ? inverted exclamation mark               */
+    -99,        /*   162    ? cent sign                               */
+    1,          /*   163    ? pound sterling sign                     */
+    36,         /*   164    ? general currency sign                   */
+    3,          /*   165    ? yen sign                                */
+    -33,        /*   166    ? broken vertical bar                     */
+    95,         /*   167    ? section sign                            */
+    -34,        /*   168    ? spacing dieresis or umlaut              */
+    NPC7,       /*   169    ? copyright sign                          */
+    NPC7,       /*   170    ? feminine ordinal indicator              */
+    -60,        /*   171    ? left (double) angle quote               */
+    NPC7,       /*   172    ? logical not sign                        */
+    -45,        /*   173    ? soft hyphen                             */
+    NPC7,       /*   174    ? registered trademark sign               */
+    NPC7,       /*   175    ? spacing macron (long) accent            */
+    NPC7,       /*   176    ? degree sign                             */
+    NPC7,       /*   177    ? plus-or-minus sign                      */
+    -50,        /*   178    ? superscript 2                           */
+    -51,        /*   179    ? superscript 3                           */
+    -39,        /*   180    ? spacing acute accent                    */
+    -117,       /*   181    ? micro sign                              */
+    NPC7,       /*   182    ? paragraph sign, pilcrow sign            */
+    NPC7,       /*   183    ? middle dot, centered dot                */
+    NPC7,       /*   184    ? spacing cedilla                         */
+    -49,        /*   185    ? superscript 1                           */
+    NPC7,       /*   186    ? masculine ordinal indicator             */
+    -62,        /*   187    ? right (double) angle quote (guillemet)  */
+    NPC7,       /*   188    ? fraction 1/4                            */
+    NPC7,       /*   189    ? fraction 1/2                            */
+    NPC7,       /*   190    ? fraction 3/4                            */
+    96,         /*   191    ? inverted question mark                  */
+    -65,        /*   192    ? uppercase A grave                       */
+    -65,        /*   193    ? uppercase A acute                       */
+    -65,        /*   194    ? uppercase A circumflex                  */
+    -65,        /*   195    ? uppercase A tilde                       */
+    91,         /*   196    ? uppercase A dieresis or umlaut          */
+    14,         /*   197    ? uppercase A ring                        */
+    28,         /*   198    ? uppercase AE ligature                   */
+    9,          /*   199    ? uppercase C cedilla                     */
+    -31,        /*   200    ? uppercase E grave                       */
+    31,         /*   201    ? uppercase E acute                       */
+    -31,        /*   202    ? uppercase E circumflex                  */
+    -31,        /*   203    ? uppercase E dieresis or umlaut          */
+    -73,        /*   204    ? uppercase I grave                       */
+    -73,        /*   205    ? uppercase I acute                       */
+    -73,        /*   206    ? uppercase I circumflex                  */
+    -73,        /*   207    ? uppercase I dieresis or umlaut          */
+    -68,        /*   208    ? uppercase ETH                           */
+    93,         /*   209    ? uppercase N tilde                       */
+    -79,        /*   210    ? uppercase O grave                       */
+    -79,        /*   211    ? uppercase O acute                       */
+    -79,        /*   212    ? uppercase O circumflex                  */
+    -79,        /*   213    ? uppercase O tilde                       */
+    92,         /*   214    ? uppercase O dieresis or umlaut          */
+    -42,        /*   215    ? multiplication sign                     */
+    11,         /*   216    ? uppercase O slash                       */
+    -85,        /*   217    ? uppercase U grave                       */
+    -85,        /*   218    ? uppercase U acute                       */
+    -85,        /*   219    ? uppercase U circumflex                  */
+    94,         /*   220    ? uppercase U dieresis or umlaut          */
+    -89,        /*   221    ? uppercase Y acute                       */
+    NPC7,       /*   222    ? uppercase THORN                         */
+    30,         /*   223    ? lowercase sharp s, sz ligature          */
+    127,        /*   224    ? lowercase a grave                       */
+    -97,        /*   225    ? lowercase a acute                       */
+    -97,        /*   226    ? lowercase a circumflex                  */
+    -97,        /*   227    ? lowercase a tilde                       */
+    123,        /*   228    ? lowercase a dieresis or umlaut          */
+    15,         /*   229    ? lowercase a ring                        */
+    29,         /*   230    ? lowercase ae ligature                   */
+    -9,         /*   231    ? lowercase c cedilla                     */
+    4,          /*   232    ? lowercase e grave                       */
+    5,          /*   233    ? lowercase e acute                       */
+    -101,       /*   234    ? lowercase e circumflex                  */
+    -101,       /*   235    ? lowercase e dieresis or umlaut          */
+    7,          /*   236    ? lowercase i grave                       */
+    7,          /*   237    ? lowercase i acute                       */
+    -105,       /*   238    ? lowercase i circumflex                  */
+    -105,       /*   239    ? lowercase i dieresis or umlaut          */
+    NPC7,       /*   240    ? lowercase eth                           */
+    125,        /*   241    ? lowercase n tilde                       */
+    8,          /*   242    ? lowercase o grave                       */
+    -111,       /*   243    ? lowercase o acute                       */
+    -111,       /*   244    ? lowercase o circumflex                  */
+    -111,       /*   245    ? lowercase o tilde                       */
+    124,        /*   246    ? lowercase o dieresis or umlaut          */
+    -47,        /*   247    ? division sign                           */
+    12,         /*   248    ? lowercase o slash                       */
+    6,          /*   249    ? lowercase u grave                       */
+    -117,       /*   250    ? lowercase u acute                       */
+    -117,       /*   251    ? lowercase u circumflex                  */
+    126,        /*   252    ? lowercase u dieresis or umlaut          */
+    -121,       /*   253    ? lowercase y acute                       */
+    NPC7,       /*   254    ? lowercase thorn                         */
+    -121        /*   255    ? lowercase y dieresis or umlaut          */
+};
+
+String PDU::decode(String pdu_text) {
+  uint8_t len = strtol(pdu_text.substring(0, 2).c_str(), NULL, 16); //the fist byte contains the number of chars
+  return pdu_decode(pdu_text.substring(2), len);
+}
+
+String PDU::decode(String pdu_text, uint8_t len) {
+  char plain_bytes[256];
+  byte high_mask = 128; // byte:10000000;
+  byte low_mask;
+  byte shift = 0;
+  byte this_byte;
+  byte high_byte_new = 0;
+  byte high_byte_old = 0;
+  byte low_byte = 0;
+  int y = 0;
+  int i = 0;
+
+  for (y = 0; y < len ; y++) {
+    this_byte = strtol(pdu_text.substring(i * 2, (i * 2) + 2).c_str(), NULL, 16);
+
+    low_mask = high_mask ^ 0xFF;                      //invert
+    high_byte_new = this_byte & high_mask;            // 10000000 = 11000111 & 10000000
+    low_byte = this_byte & low_mask;                  // 01000111 = 11000111 & 01111111
+
+    plain_bytes[y] = low_byte << shift;               // 10001110
+    high_byte_old = high_byte_old >> (8 - shift);     // 00000001
+    plain_bytes[y] =  plain_bytes[y] + high_byte_old; // 10001111
+
+    if (shift == 6) {
+      y++;
+      plain_bytes[y] = high_byte_new >> 1;
+    }
+
+    high_mask = high_mask >> 1;                       // 10000000 > 01000000
+    high_mask = high_mask + 128;                      // 01000000 > 11000000
+    if (high_mask == 255)high_mask = 128;             // 11111111 > 10000000
+    low_mask = high_mask ^ 0xFF;                      // invert
+
+    high_byte_old = high_byte_new;
+    shift++;
+    if (shift == 7) {
+      shift = 0;
+    }
+    i++;
+  }
+  plain_bytes[y] = 0;
+
+  char *plain_text = new char[y];
+  strcpy(plain_text, plain_bytes);
+
+  return plain_text;
+}
+
+
+String PDU::semiOctetToString (String semiOctet) {
+  unsigned int i;
+  String OctetString;
+
+  for (i = 0; i < ( semiOctet.length() / 2 ); i++) {
+    OctetString += semiOctet.substring(i*2 + 1,i*2 + 1+1);
+    OctetString += semiOctet.substring(i*2, i*2+1);
+  }
+  return OctetString;
+}
+
+String PDU::stringToSemiOctet (String StringData) {
+  if ( StringData.length() % 2 != 0 ) {
+    StringData += "F";
+  }
+
+  return semiOctetToString(StringData);
+}
+
+int PDU::hexStringToInt (String hexString) {
+  unsigned int i;
+  int charvalue;
+  int returnvalue = 0;
+
+  for (i = 0; i < hexString.length(); i++) {
+    if ( hexString[i] >= 'a' && hexString[i] <= 'f' ) {
+      charvalue = (int) hexString[i] - 87;
+    }
+    if ( hexString[i] >= 'A' && hexString[i] <= 'F' ) {
+      charvalue = (int) hexString[i] - 55;
+    }
+    if ( hexString[i] >= '0' && hexString[i] <= '9' ) {
+      charvalue = (int) hexString[i] - 48;
+    }
+    returnvalue += charvalue * ( pow(16, (int)(hexString.length() - (i + 1)) ));
+  }
+  return returnvalue;
+}
+
+
+
+String PDU::intToHexString (int integer) {
+  String hexString = "";
+  //Conversion from intToHex
+  char buf[3];
+  sprintf(buf,"%X",integer);
+  hexString = (String)buf;
+  //Prepend a 0 when not even
+  if ( hexString.length() % 2 != 0 ){
+    hexString = "0" + hexString;
+  }
+
+  return hexString;
+}
+
+
+
+int PDU::binStringToInt (String binString) {
+
+  unsigned int pos;
+  int integerReturn = 0;
+  int base = 2;
+
+  for (pos = 0; pos < binString.length(); pos++) {
+    if ( binString.substring(pos, pos+1) == "1" ) {
+      integerReturn += pow(base, (binString.length() - (pos + 1)) );
+    }
+  }
+  return integerReturn;
+}
+
+
+
+String PDU::intToBinString (int integer) {
+  String stringReturn;
+
+  if (integer <= 0) {
+    return "0";
+  }
+
+  while ( integer > 0 ) {
+    if ( integer % 2 == 1 ) {
+      stringReturn = "1" + stringReturn;
+      --integer;
+    } else {
+      stringReturn = "0" + stringReturn;
+    }
+    integer = integer / 2;
+  }
+  //Changed 8 to 7 because the characters are in septets
+  while ( stringReturn.length() % 7 != 0 ) {
+    stringReturn = "0" + stringReturn;
+  }
+  return stringReturn;
+}
+
+
+
+int PDU::pow(int n, int i)
+{
+  if (i == 0)
+    return 1;
+  else if (i == 1)
+    return n;
+  else {
+    int partial = pow(n, i / 2);
+    if (i % 2 == 0)
+      return partial * partial;
+    else
+      return partial * partial * n;
+  }
+}
+
+
+
+int PDU::setText( String smstext ) {
+  if ( smstext.length() > 160 ) {
+    return 0;
+  }
+  this->tp_text = smstext;
+  return 1;
+}
+
+int PDU::setSender( String number ) {
+
+  this->sender_type_of_address = 146;
+  if ( number.substring(0,1) == "+" ) {
+    this->sender_type_of_address = 145;
+    this->sender_number = number.substring(1, number.length());
+  } else {
+    this->sender_number = number;
+  }
+
+  this->sender_length = this->sender_number.length();
+  if ( this->sender_number.length() % 2 == 1 ) {
+    this->sender_number + "F";
+  }
+
+  return 1;
+}
+
+String PDU::userTextTo7(void) {
+
+  unsigned int pos;
+  String current, octetFirst, octetSecond, currentOctet;
+  String output;
+
+  for (pos = 0; pos < this->tp_text.length(); pos++) {
+    current = intToBinString(lookup_ascii8to7[ this->tp_text[pos] ]);
+    if ( ( pos != 0 ) && ( pos % 8 != 0 ) ) {
+      octetFirst = current.substring(7 - ( pos % 8 ), current.length() );
+      currentOctet = octetFirst + octetSecond;
+      output += intToHexString(binStringToInt(currentOctet));
+      octetSecond = current.substring(0,  7 - (pos % 8));
+    }
+    else {
+      octetSecond = current.substring(0, 7 - (pos % 8));
+    }
+
+    if ( ( pos + 1 == this->tp_text.length() ) && ( octetSecond != "" ) ) {
+      output += intToHexString(binStringToInt(octetSecond));
+    }
+
+  }
+  return output;
+}
+
+String PDU::encode() {
+  String pduString;
+
+  pduString = "00";                                           // SMSC_LENGHT
+  pduString += "1100";                                        // FIRST OCTET ( message submit & tp reference)
+  pduString += intToHexString(this->sender_length);           // SENDER_LENGHT
+  pduString += intToHexString(this->sender_type_of_address);  // SENDER_TYPE
+  pduString += stringToSemiOctet(this->sender_number);        // SENDER_NUMBER
+  pduString += "0000";                                        // TP-PID TP-DCS ( 7-bit default encoding )
+  pduString += "AA";                                          // VALIDITY ( 4 days )
+  pduString += intToHexString(this->tp_text.length());
+  pduString += userTextTo7();
+  return pduString;
+}

libPDU.h

@@ -0,0 +1,47 @@
+#ifndef LIBPDU_H
+#define LIBPDU_H
+
+
+#define NPC7    63
+
+
+class PDU {
+
+  public:
+    PDU (){ this->tp_dcs_alpha = 0; };
+    ~PDU (){};
+    int setText(String);
+    int setSender(String);
+    String encode(void);
+    String decode(String);
+    String decode(String, uint8_t);
+
+  private:
+    int     smsc_length;
+    int     smsc_type_of_address;
+    String  smsc_number;
+    int     sms_deliver;                    //SMS-DELIVER message
+    int     sender_length;
+    int     sender_type_of_address;
+    String  sender_number;
+    int     tp_length;                      // lenght of data ( dependent of dcs)
+    String  tp_data;                        // the data of the message
+    String  tp_text;                        //--internal use for storing sms text before creating the pdu string
+    int     tp_dcs_alpha;                   //--internal use for storing alphabet size when creating the pdu string
+
+    String semiOctetToString (String);
+    String stringToSemiOctet (String);
+
+    int hexStringToInt (String);
+    String intToHexString (int);
+
+    int binStringToInt (String);
+    String intToBinString (int);
+
+    int pow(int , int );
+    String userTextTo7(void);
+
+};
+
+
+#endif //LIBPDU_LIBPDU_H