Handle UCS-2 data coding scheme for SMS messsages.

utilities.cc

-// Copyright (c) 2010 The Chromium OS Authors. All rights reserved.
+// Copyright (c) 2011 The Chromium OS Authors. All rights reserved.
 // Use of this source code is governed by a BSD-style license that can be
 // found in the LICENSE file.
 
 // Plugin tests link against this file, but not against the rest of
 // cromo.  Therefore this file should not have dependencies on the
 // rest of cromo.
 #include "utilities.h"
 
 #include <glog/logging.h>
 #include <stdio.h>
@@ skipping 254 matching lines @@
         octet |= septets.at(k+1) << (7-shift);
       octets.push_back(octet);
     }
     if (++shift == 8)
       shift = 0;
   }
 
   return octets;
 }
 
+std::string Ucs2ToUtf8String(const uint8_t *ucs2) {
+  std::string str;
+  uint8_t num_chars = *ucs2++ >> 1;
+
+  for (int i = 0; i < num_chars; ++i) {
+    uint16_t ucs2char = ucs2[0] << 8 | ucs2[1];
+    if (ucs2char <= 0x7f) {
+      str += ucs2[1];
+    } else if (ucs2char <= 0x7ff) {
+      str += (uint8_t)(0xc0 | ((ucs2char & 0x7c0) >> 6));
+      str += (uint8_t)(0x80 | (ucs2char & 0x3f));
+    } else {
+      str += (uint8_t)(0xe0 | ((ucs2char & 0xf000) >> 12));
+      str += (uint8_t)(0x80 | ((ucs2char & 0xfc0) >> 6));
+      str += (uint8_t)(0x80 | (ucs2char & 0x3f));
+    }
+    ucs2 += 2;
+  }
+  return str;
+}
+
+std::vector<uint8_t> Utf8StringToUcs2(const std::string& input)
+{
+  std::vector<uint8_t> octets;
+  size_t length = input.length();
+
+  // First byte gives the length in octets of the UCS-2 string
+  // Insert a placeholder value until we know the true length.
+  octets.push_back(0);
+  for (size_t i = 0; i < length; i++) {
+    char char1 = input.at(i);
+    // Check whether this is a one byte UTF-8 sequence, or the
+    // start of a two or three byte sequence.
+    if ((char1 & 0x80) == 0) {
+      octets.push_back(0);
+      octets.push_back(char1);
+    } else if ((char1 & 0xe0) == 0xc0) {
+      uint8_t char2 = input.at(++i);
+      octets.push_back((char1 >> 2) & 0x7);
+      octets.push_back(((char1 & 0x3) << 6) | (char2 & 0x3f));
+    } else if ((char1 & 0xf0) == 0xe0) {
+      uint8_t char2 = input.at(++i);
+      uint8_t char3 = input.at(++i);
+      octets.push_back(((char1 & 0xf) << 4) | ((char2 & 0x30) >> 2));
+      octets.push_back(((char2 & 0x3) << 6) | (char3 & 0x3f));
+    } else {
+      // character not representable in UCS-2, insert a space
+      octets.push_back(0);
+      octets.push_back(' ');
+    }
+  }
+  octets[0] = octets.size() - 1;
+  return octets;
+}
+
 void DumpHex(const uint8_t* buf, size_t size) {
   size_t nlines = (size+15) / 16;
   size_t limit;
 
   for (size_t i = 0; i < nlines; i++) {
     std::ostringstream ostr;
     ostr << std::hex;
     ostr.fill('0');
     ostr.width(8);
     if (i*16 + 16 >= size)
       limit = size - i*16;
     else
       limit = 16;
     ostr << i*16 << "  ";
     ostr.fill('0');
     ostr.width(2);
     for (size_t j = 0; j < limit; j++) {
       uint8_t byte = buf[i*16+j];
       ostr << std::setw(0) << " " << std::setw(2) << std::setfill('0')
            << static_cast<unsigned int>(byte);
     }
     LOG(INFO) << ostr.str();
   }
 }
 
 }  // namespace utilities