bd5e2aef6d05a0361a78b539bc280e2223ee8896
[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 #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 }