int Convert_16_To_32(short icolor)
{
    // icolor is a 16 bit color

    int b = (icolor & 0x1F) >> 11;
    int g = (icolor & 0x7E0) >> 5;
    int r = icolor & F800;

    r *= 256;
    r /= 32;

    g *= 256;
    g /= 32;

    b *= 256;
    b /= 32;

    int color = ((r << 16) | (g << 8) | b);
    color |= 0xFF000000;    // Possibly optional command for completely opaque alpha?

    return(color);
}

// We'll use template parameters to specify the widths of fields instead of// function parameters. This forces the compiler to do some of the inlining// work, at the expense of some flexibility. That is, with this approach we// have to know ahead of time - i.e., with compile-time constants - what field// widths/positions to use.// In our case, it also makes the calling code a little prettier: the template// parameters get separated visually from the function parameter that holds the// input data to be field-shifted.// Shift bits [input_low, input_high) of input to [output_low, output_high),// left-aligning the value within the output field. Return the resulting value// for just that field (with the shift applied).template <int input_low, int input_high, int output_low, int output_high>int shiftedField(int input) {  // Mask out the field.  input &= (1 << input_high) - (1 << input_low);  // Have to branch here because shifting by a negative amount isn't kosher.  if (output_high > input_high) {    input <<= (output_high - input_high);  } else if (output_high < input_high) {    input >>= (input_high - output_high);  } // otherwise, do nothing ;)  // Clear any bits below output_low, by creating the mask for bits 0 to  // output_low and negating it.  input &= ~((1 << output_low) - 1);}

// It's easy to confirm visually that we have the right parameters in the// templates: adjacent "fields" share begin/end points, and the difference// between pairs gives the field widths.int 565toFullColor(short input) {  return 0xff000000 | // alpha         shiftedField<11,16,16,24>(input) | // r         shiftedField< 5,11, 8,16>(input) | // g         shiftedField< 0, 5, 0, 8>(input); // b}int 555toFullColor(short input) {  return 0xff000000 | // alpha         shiftedField<10,15,16,24>(input) | // r         shiftedField< 5,10, 8,16>(input) | // g         shiftedField< 0, 5, 0, 8>(input); // b}// To go the other way, just reverse the field width specifications:short FullColorto565(int input) {  return shiftedField<16,24,11,16>(input) | // r         shiftedField< 8,16, 5,11>(input) | // g         shiftedField< 0, 8, 0, 5>(input); // b}short FullColorto555(int input) {  return shiftedField<16,24,10,15>(input) | // r         shiftedField< 8,16, 5,10>(input) | // g         shiftedField< 0, 8, 0, 5>(input); // b}