disp: Log signal strength
[samsung-ril.git] / 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         LOGD("Signal Strength is %d\n", asu);
88
89 #if RIL_VERSION >= 6
90         memset(ss, 0, sizeof(RIL_SignalStrength_v6));
91         memset(&ss->LTE_SignalStrength, -1, sizeof(ss->LTE_SignalStrength));
92 #else
93         memset(ss, 0, sizeof(RIL_SignalStrength));
94 #endif
95
96         ss->GW_SignalStrength.signalStrength = asu;
97         ss->GW_SignalStrength.bitErrorRate = 99;
98 }
99
100 void ril_request_signal_strength(RIL_Token t)
101 {
102         unsigned char request = 1;
103
104         ipc_fmt_send(IPC_DISP_ICON_INFO, IPC_TYPE_GET, &request, sizeof(request), ril_request_get_id(t));
105 }
106
107 void ipc_disp_icon_info(struct ipc_message_info *info)
108 {
109         struct ipc_disp_icon_info *icon_info = (struct ipc_disp_icon_info *) info->data;
110 #if RIL_VERSION >= 6
111         RIL_SignalStrength_v6 ss;
112 #else
113         RIL_SignalStrength ss;
114 #endif
115
116         /* Don't consider this if modem isn't in normal power mode. */
117         if (ril_data.state.power_state != IPC_PWR_PHONE_STATE_NORMAL)
118                 return;
119
120         if (info->type == IPC_TYPE_NOTI) {
121                 ipc2ril_bars(icon_info->bars, &ss);
122                 ril_request_unsolicited(RIL_UNSOL_SIGNAL_STRENGTH, &ss, sizeof(ss));
123         } else {
124                 ipc2ril_rssi(icon_info->rssi, &ss);
125                 ril_request_complete(ril_request_get_token(info->aseq), RIL_E_SUCCESS, &ss, sizeof(ss));
126         }
127 }
128
129 void ipc_disp_rssi_info(struct ipc_message_info *info)
130 {
131         struct ipc_disp_rssi_info *rssi_info = (struct ipc_disp_rssi_info *) info->data;
132 #if RIL_VERSION >= 6
133         RIL_SignalStrength_v6 ss;
134 #else
135         RIL_SignalStrength ss;
136 #endif
137         int rssi;
138
139         /* Don't consider this if modem isn't in normal power mode. */
140         if (ril_data.state.power_state != IPC_PWR_PHONE_STATE_NORMAL)
141                 return;
142
143         ipc2ril_rssi(rssi_info->rssi, &ss);
144
145         ril_request_unsolicited(RIL_UNSOL_SIGNAL_STRENGTH, &ss, sizeof(ss));
146 }