|
1 /* This Source Code Form is subject to the terms of the Mozilla Public |
|
2 * License, v. 2.0. If a copy of the MPL was not distributed with this file, |
|
3 * You can obtain one at http://mozilla.org/MPL/2.0/. */ |
|
4 #include "Hal.h" |
|
5 #include "nsITimer.h" |
|
6 #include "smslib.h" |
|
7 #include "nsComponentManagerUtils.h" |
|
8 |
|
9 #include <mach/mach.h> |
|
10 #include <cmath> |
|
11 #import <IOKit/IOKitLib.h> |
|
12 |
|
13 #define MEAN_GRAVITY 9.80665 |
|
14 #define DEFAULT_SENSOR_POLL 100 |
|
15 using namespace mozilla::hal; |
|
16 namespace mozilla { |
|
17 namespace hal_impl { |
|
18 static nsITimer* sUpdateTimer = nullptr; |
|
19 static bool sActiveSensors[NUM_SENSOR_TYPE]; |
|
20 static io_connect_t sDataPort = IO_OBJECT_NULL; |
|
21 static uint64_t sLastMean = -1; |
|
22 static float |
|
23 LMUvalueToLux(uint64_t aValue) |
|
24 { |
|
25 //Conversion formula from regression. See Bug 793728. |
|
26 // -3*(10^-27)*x^4 + 2.6*(10^-19)*x^3 + -3.4*(10^-12)*x^2 + 3.9*(10^-5)*x - 0.19 |
|
27 long double powerC4 = 1/pow((long double)10,27); |
|
28 long double powerC3 = 1/pow((long double)10,19); |
|
29 long double powerC2 = 1/pow((long double)10,12); |
|
30 long double powerC1 = 1/pow((long double)10,5); |
|
31 |
|
32 long double term4 = -3.0 * powerC4 * pow(aValue,4); |
|
33 long double term3 = 2.6 * powerC3 * pow(aValue,3); |
|
34 long double term2 = -3.4 * powerC2 * pow(aValue,2); |
|
35 long double term1 = 3.9 * powerC1 * aValue; |
|
36 |
|
37 float lux = ceil(static_cast<float>(term4 + term3 + term2 + term1 - 0.19)); |
|
38 return lux > 0 ? lux : 0; |
|
39 } |
|
40 void |
|
41 UpdateHandler(nsITimer *aTimer, void *aClosure) |
|
42 { |
|
43 for (int i = 0; i < NUM_SENSOR_TYPE; i++) { |
|
44 if (!sActiveSensors[i]) { |
|
45 continue; |
|
46 } |
|
47 SensorType sensor = static_cast<SensorType>(i); |
|
48 InfallibleTArray<float> values; |
|
49 if (sensor == SENSOR_ACCELERATION) { |
|
50 sms_acceleration accel; |
|
51 smsGetData(&accel); |
|
52 |
|
53 values.AppendElement(accel.x * MEAN_GRAVITY); |
|
54 values.AppendElement(accel.y * MEAN_GRAVITY); |
|
55 values.AppendElement(accel.z * MEAN_GRAVITY); |
|
56 } else if (sensor == SENSOR_LIGHT && sDataPort != IO_OBJECT_NULL) { |
|
57 kern_return_t kr; |
|
58 uint32_t outputs = 2; |
|
59 uint64_t lightLMU[outputs]; |
|
60 |
|
61 kr = IOConnectCallMethod(sDataPort, 0, nil, 0, nil, 0, lightLMU, &outputs, nil, 0); |
|
62 if (kr == KERN_SUCCESS) { |
|
63 uint64_t mean = (lightLMU[0] + lightLMU[1]) / 2; |
|
64 if (mean == sLastMean) { |
|
65 continue; |
|
66 } |
|
67 sLastMean = mean; |
|
68 values.AppendElement(LMUvalueToLux(mean)); |
|
69 } else if (kr == kIOReturnBusy) { |
|
70 continue; |
|
71 } |
|
72 } |
|
73 |
|
74 hal::SensorData sdata(sensor, |
|
75 PR_Now(), |
|
76 values, |
|
77 hal::SENSOR_ACCURACY_UNKNOWN); |
|
78 hal::NotifySensorChange(sdata); |
|
79 } |
|
80 } |
|
81 void |
|
82 EnableSensorNotifications(SensorType aSensor) |
|
83 { |
|
84 if (aSensor == SENSOR_ACCELERATION) { |
|
85 int result = smsStartup(nil, nil); |
|
86 |
|
87 if (result != SMS_SUCCESS) { |
|
88 return; |
|
89 } |
|
90 |
|
91 if (!smsLoadCalibration()) { |
|
92 return; |
|
93 } |
|
94 } else if (aSensor == SENSOR_LIGHT) { |
|
95 io_service_t serviceObject; |
|
96 serviceObject = IOServiceGetMatchingService(kIOMasterPortDefault, |
|
97 IOServiceMatching("AppleLMUController")); |
|
98 if (!serviceObject) { |
|
99 return; |
|
100 } |
|
101 kern_return_t kr; |
|
102 kr = IOServiceOpen(serviceObject, mach_task_self(), 0, &sDataPort); |
|
103 IOObjectRelease(serviceObject); |
|
104 if (kr != KERN_SUCCESS) { |
|
105 return; |
|
106 } |
|
107 } else { |
|
108 NS_WARNING("EnableSensorNotifications called on an unknown sensor type"); |
|
109 return; |
|
110 } |
|
111 sActiveSensors[aSensor] = true; |
|
112 |
|
113 if (!sUpdateTimer) { |
|
114 CallCreateInstance("@mozilla.org/timer;1", &sUpdateTimer); |
|
115 if (sUpdateTimer) { |
|
116 sUpdateTimer->InitWithFuncCallback(UpdateHandler, |
|
117 nullptr, |
|
118 DEFAULT_SENSOR_POLL, |
|
119 nsITimer::TYPE_REPEATING_SLACK); |
|
120 } |
|
121 } |
|
122 } |
|
123 void |
|
124 DisableSensorNotifications(SensorType aSensor) |
|
125 { |
|
126 if (!sActiveSensors[aSensor] || (aSensor != SENSOR_ACCELERATION && aSensor != SENSOR_LIGHT)) { |
|
127 return; |
|
128 } |
|
129 |
|
130 sActiveSensors[aSensor] = false; |
|
131 |
|
132 if (aSensor == SENSOR_ACCELERATION) { |
|
133 smsShutdown(); |
|
134 } else if (aSensor == SENSOR_LIGHT) { |
|
135 IOServiceClose(sDataPort); |
|
136 } |
|
137 // If all sensors are disabled, cancel the update timer. |
|
138 if (sUpdateTimer) { |
|
139 for (int i = 0; i < NUM_SENSOR_TYPE; i++) { |
|
140 if (sActiveSensors[i]) { |
|
141 return; |
|
142 } |
|
143 } |
|
144 sUpdateTimer->Cancel(); |
|
145 NS_RELEASE(sUpdateTimer); |
|
146 } |
|
147 } |
|
148 } // hal_impl |
|
149 } // mozilla |