disp.c

   1 /**
   2  * This file is part of samsung-ril.
   3  *
   4  * Copyright (C) 2010-2011 Joerie de Gram <j.de.gram@gmail.com>
   5  * Copyright (C) 2011-2012 Paul Kocialkowski <contact@paulk.fr>
   6  *
   7  * Based on CyanogenMod Smdk4210RIL implementation
   8  * Copyright (C) 2011 The CyanogenMod Project
   9  *
  10  * samsung-ril is free software: you can redistribute it and/or modify
  11  * it under the terms of the GNU General Public License as published by
  12  * the Free Software Foundation, either version 3 of the License, or
  13  * (at your option) any later version.
  14  *
  15  * samsung-ril is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with samsung-ril.  If not, see <http://www.gnu.org/licenses/>.
  22  *
  23  */
  24
  25 #define LOG_TAG "RIL-DISP"
  26 #include <utils/Log.h>
  27
  28 #include "samsung-ril.h"
  29 #include "util.h"
  30
  31 /**
  32  * Converts IPC RSSI to Android RIL format
  33  */
  34 #if RIL_VERSION >= 6
  35 void ipc2ril_rssi(unsigned char rssi, RIL_SignalStrength_v6 *ss)
  36 #else
  37 void ipc2ril_rssi(unsigned char rssi, RIL_SignalStrength *ss)
  38 #endif
  39 {
  40         int asu = 0;
  41
  42         if (ss == NULL)
  43                 return;
  44
  45         if (rssi > 0x6f) {
  46                 asu = 0;
  47         } else {
  48                 asu = (((rssi - 0x71) * -1) - ((rssi - 0x71) * -1) % 2) / 2;
  49                 if (asu > 31)
  50                         asu = 31;
  51         }
  52
  53         LOGD("Signal Strength is %d\n", asu);
  54
  55 #if RIL_VERSION >= 6
  56         memset(ss, 0, sizeof(RIL_SignalStrength_v6));
  57         memset(&ss->LTE_SignalStrength, -1, sizeof(ss->LTE_SignalStrength));
  58 #else
  59         memset(ss, 0, sizeof(RIL_SignalStrength));
  60 #endif
  61
  62         ss->GW_SignalStrength.signalStrength = asu;
  63         ss->GW_SignalStrength.bitErrorRate = 99;
  64 }
  65
  66 #if RIL_VERSION >= 6
  67 void ipc2ril_bars(unsigned char bars, RIL_SignalStrength_v6 *ss)
  68 #else
  69 void ipc2ril_bars(unsigned char bars, RIL_SignalStrength *ss)
  70 #endif
  71 {
  72         int asu = 0;
  73
  74         if (ss == NULL)
  75                 return;
  76
  77         switch (bars) {
  78                 case 0  : asu = 1;      break;
  79                 case 1  : asu = 3;      break;
  80                 case 2  : asu = 5;      break;
  81                 case 3  : asu = 8;      break;
  82                 case 4  : asu = 12;     break;
  83                 case 5  : asu = 15;     break;
  84                 default : asu = bars ;  break;
  85         }
  86
  87 #if RIL_VERSION >= 6
  88         memset(ss, 0, sizeof(RIL_SignalStrength_v6));
  89         memset(&ss->LTE_SignalStrength, -1, sizeof(ss->LTE_SignalStrength));
  90 #else
  91         memset(ss, 0, sizeof(RIL_SignalStrength));
  92 #endif
  93
  94         ss->GW_SignalStrength.signalStrength = asu;
  95         ss->GW_SignalStrength.bitErrorRate = 99;
  96 }
  97
  98 void ril_request_signal_strength(RIL_Token t)
  99 {
 100         unsigned char request = 1;
 101
 102         ipc_fmt_send(IPC_DISP_ICON_INFO, IPC_TYPE_GET, &request, sizeof(request), ril_request_get_id(t));
 103 }
 104
 105 void ipc_disp_icon_info(struct ipc_message_info *info)
 106 {
 107         struct ipc_disp_icon_info *icon_info = (struct ipc_disp_icon_info *) info->data;
 108 #if RIL_VERSION >= 6
 109         RIL_SignalStrength_v6 ss;
 110 #else
 111         RIL_SignalStrength ss;
 112 #endif
 113
 114         /* Don't consider this if modem isn't in normal power mode. */
 115         if (ril_data.state.power_state != IPC_PWR_PHONE_STATE_NORMAL)
 116                 return;
 117
 118         if (info->type == IPC_TYPE_NOTI) {
 119                 ipc2ril_bars(icon_info->bars, &ss);
 120                 ril_request_unsolicited(RIL_UNSOL_SIGNAL_STRENGTH, &ss, sizeof(ss));
 121         } else {
 122                 ipc2ril_rssi(icon_info->rssi, &ss);
 123                 ril_request_complete(ril_request_get_token(info->aseq), RIL_E_SUCCESS, &ss, sizeof(ss));
 124         }
 125 }
 126
 127 void ipc_disp_rssi_info(struct ipc_message_info *info)
 128 {
 129         struct ipc_disp_rssi_info *rssi_info = (struct ipc_disp_rssi_info *) info->data;
 130 #if RIL_VERSION >= 6
 131         RIL_SignalStrength_v6 ss;
 132 #else
 133         RIL_SignalStrength ss;
 134 #endif
 135         int rssi;
 136
 137         /* Don't consider this if modem isn't in normal power mode. */
 138         if (ril_data.state.power_state != IPC_PWR_PHONE_STATE_NORMAL)
 139                 return;
 140
 141         ipc2ril_rssi(rssi_info->rssi, &ss);
 142
 143         ril_request_unsolicited(RIL_UNSOL_SIGNAL_STRENGTH, &ss, sizeof(ss));
 144 }