Index: chrome/browser/device_orientation/accelerometer_mac.cc |
=================================================================== |
--- chrome/browser/device_orientation/accelerometer_mac.cc (revision 75978) |
+++ chrome/browser/device_orientation/accelerometer_mac.cc (working copy) |
@@ -1,412 +0,0 @@ |
-// Copyright (c) 2011 The Chromium Authors. All rights reserved. |
-// Use of this source code is governed by a BSD-style license that can be |
-// found in the LICENSE file. |
-// |
-// This file is based on the SMSLib library. |
-// |
-// SMSLib Sudden Motion Sensor Access Library |
-// Copyright (c) 2010 Suitable Systems |
-// All rights reserved. |
-// |
-// Developed by: Daniel Griscom |
-// Suitable Systems |
-// http://www.suitable.com |
-// |
-// Permission is hereby granted, free of charge, to any person obtaining a |
-// copy of this software and associated documentation files (the |
-// "Software"), to deal with the Software without restriction, including |
-// without limitation the rights to use, copy, modify, merge, publish, |
-// distribute, sublicense, and/or sell copies of the Software, and to |
-// permit persons to whom the Software is furnished to do so, subject to |
-// the following conditions: |
-// |
-// - Redistributions of source code must retain the above copyright notice, |
-// this list of conditions and the following disclaimers. |
-// |
-// - Redistributions in binary form must reproduce the above copyright |
-// notice, this list of conditions and the following disclaimers in the |
-// documentation and/or other materials provided with the distribution. |
-// |
-// - Neither the names of Suitable Systems nor the names of its |
-// contributors may be used to endorse or promote products derived from |
-// this Software without specific prior written permission. |
-// |
-// THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS |
-// OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
-// MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. |
-// IN NO EVENT SHALL THE CONTRIBUTORS OR COPYRIGHT HOLDERS BE LIABLE FOR |
-// ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, |
-// TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE |
-// SOFTWARE OR THE USE OR OTHER DEALINGS WITH THE SOFTWARE. |
-// |
-// For more information about SMSLib, see |
-// <http://www.suitable.com/tools/smslib.html> |
-// or contact |
-// Daniel Griscom |
-// Suitable Systems |
-// 1 Centre Street, Suite 204 |
-// Wakefield, MA 01880 |
-// (781) 665-0053 |
- |
-#include "chrome/browser/device_orientation/accelerometer_mac.h" |
- |
-#include <math.h> |
-#include <sys/sysctl.h> |
- |
-#include "base/logging.h" |
-#include "base/scoped_ptr.h" |
-#include "chrome/browser/device_orientation/orientation.h" |
- |
-namespace device_orientation { |
- |
-struct AccelerometerMac::GenericMacbookSensor { |
- // Name of device to be read. |
- const char* service_name; |
- |
- // Number of bytes of the axis data. |
- int axis_size; |
- |
- // Default calibration value for zero g. |
- float zero_g; |
- |
- // Default calibration value for one g (negative when axis is inverted). |
- float one_g; |
- |
- // Kernel function index. |
- unsigned int function; |
- |
- // Size of the sensor record to be sent/received. |
- unsigned int record_size; |
-}; |
- |
-struct AccelerometerMac::AxisData { |
- // Location of the first byte representing the axis in the sensor data. |
- int index; |
- |
- // Axis inversion flag. The value changes often between models. |
- bool inverted; |
-}; |
- |
-// Sudden Motion Sensor descriptor. |
-struct AccelerometerMac::SensorDescriptor { |
- // Prefix of model to be tested. |
- const char* model_name; |
- |
- // Axis-specific data (x,y,z order). |
- AxisData axis[3]; |
-}; |
- |
-// Typical sensor parameters in MacBook models. |
-const AccelerometerMac::GenericMacbookSensor |
- AccelerometerMac::kGenericSensor = { |
- "SMCMotionSensor", 2, |
- 0, 251, |
- 5, 40 |
-}; |
- |
-// Supported sensor descriptors. Add entries here to enhance compatibility. |
-// All non-tested entries from SMSLib have been removed. |
-const AccelerometerMac::SensorDescriptor |
- AccelerometerMac::kSupportedSensors[] = { |
- // Tested by tommyw on a 13" MacBook. |
- { "MacBook1,1", { { 0, true }, { 2, true }, { 4, false } } }, |
- |
- // Tested by S.Selz. (via avi) on a 13" MacBook. |
- { "MacBook2,1", { { 0, true }, { 2, false }, { 4, true } } }, |
- |
- // Tested by verhees on a 13" MacBook. |
- { "MacBook3,1", { { 0, true }, { 2, true }, { 4, false } } }, |
- |
- // Tested by adlr on a 13" MacBook. |
- { "MacBook4,1", { { 0, true }, { 2, true }, { 4, false } } }, |
- |
- // Tested by tommyw on a 13" MacBook. |
- { "MacBook6,1", { { 0, true }, { 2, true }, { 4, false } } }, |
- |
- // Tested by avi on a 13" MacBook. |
- { "MacBook7,1", { { 0, true }, { 2, true }, { 4, false } } }, |
- |
- // Tested by crc on a 13" MacBook Air. |
- { "MacBookAir1,1", { { 0, true }, { 2, true }, { 4, false } } }, |
- |
- // Tested by sfiera, pjw on a 13" MacBook Air. |
- { "MacBookAir2,1", { { 0, true }, { 2, true }, { 4, false } } }, |
- |
- // Note: MacBookAir3,1 (11" MacBook Air) and MacBookAir3,2 (13" MacBook Air) |
- // have no accelerometer sensors. |
- |
- // Tested by crc on a 15" MacBook Pro. |
- { "MacBookPro1,1", { { 0, true }, { 2, true }, { 4, false } } }, |
- |
- // Tested by L.V. (via avi) on a 17" MacBook Pro. |
- { "MacBookPro2,1", { { 0, true }, { 2, false }, { 4, true } } }, |
- |
- // Tested by leandrogracia on a 15" MacBook Pro. |
- { "MacBookPro2,2", { { 0, true }, { 2, true }, { 4, false } } }, |
- |
- // Tested by leandrogracia on a 15" MacBook Pro. |
- // TODO(avi): this model name was also used for the 17" version; verify that |
- // these parameters are also valid for that model. |
- { "MacBookPro3,1", { { 0, false }, { 2, true }, { 4, true } } }, |
- |
- // Tested by leandrogracia on a 15" MacBook Pro. |
- // Tested by Eric Shapiro (via avi) on a 17" MacBook Pro. |
- { "MacBookPro4,1", { { 0, true }, { 2, true }, { 4, false } } }, |
- |
- // Tested by leandrogracia on a 15" MacBook Pro. |
- { "MacBookPro5,1", { { 0, false }, { 2, false }, { 4, false } } }, |
- |
- // Tested by S.Selz. (via avi) on a 17" MacBook Pro. |
- { "MacBookPro5,2", { { 0, false }, { 2, false }, { 4, false } } }, |
- |
- // Tested by dmaclach on a 15" MacBook Pro. |
- { "MacBookPro5,3", { { 2, false }, { 0, false }, { 4, true } } }, |
- |
- // Tested by leandrogracia on a 15" MacBook Pro. |
- { "MacBookPro5,4", { { 0, false }, { 2, false }, { 4, false } } }, |
- |
- // Tested by leandrogracia on a 13" MacBook Pro. |
- { "MacBookPro5,5", { { 0, true }, { 2, true }, { 4, false } } }, |
- |
- // Tested by khom, leadpipe on a 17" MacBook Pro. |
- { "MacBookPro6,1", { { 0, false }, { 2, false }, { 4, false } } }, |
- |
- // Tested by leandrogracia on a 15" MacBook Pro. |
- { "MacBookPro6,2", { { 0, true }, { 2, false }, { 4, true } } }, |
- |
- // Tested by leandrogracia on a 13" MacBook Pro. |
- { "MacBookPro7,1", { { 0, true }, { 2, true }, { 4, false } } }, |
- |
- // Generic MacBook accelerometer sensor data, used for for both future models |
- // and past models for which there has been no testing. Note that this generic |
- // configuration may well have problems with inverted axes. |
- // TODO(avi): Find these past models and test on them; test on future models. |
- // MacBook5,1 |
- // MacBook5,2 |
- // MacBookPro1,2 |
- // MacBookPro3,1 (17" to compare to 15") |
- { "", { { 0, true }, { 2, true }, { 4, false } } } |
-}; |
- |
-// Create a AccelerometerMac object and return NULL if no valid sensor found. |
-DataFetcher* AccelerometerMac::Create() { |
- scoped_ptr<AccelerometerMac> accelerometer(new AccelerometerMac); |
- return accelerometer->Init() ? accelerometer.release() : NULL; |
-} |
- |
-AccelerometerMac::~AccelerometerMac() { |
- IOServiceClose(io_connection_); |
-} |
- |
-AccelerometerMac::AccelerometerMac() |
- : sensor_(NULL), |
- io_connection_(0) { |
-} |
- |
-// Retrieve per-axis accelerometer values. |
-// |
-// Axes and angles are defined according to the W3C DeviceOrientation Draft. |
-// See here: http://dev.w3.org/geo/api/spec-source-orientation.html |
-// |
-// Note: only beta and gamma angles are provided. Alpha is set to zero. |
-// |
-// Returns false in case of error or non-properly initialized object. |
-// |
-bool AccelerometerMac::GetOrientation(Orientation* orientation) { |
- DCHECK(sensor_); |
- |
- // Reset output record memory buffer. |
- std::fill(output_record_.begin(), output_record_.end(), 0x00); |
- |
- // Read record data from memory. |
- const size_t kInputSize = kGenericSensor.record_size; |
- size_t output_size = kGenericSensor.record_size; |
- |
- if (IOConnectCallStructMethod(io_connection_, kGenericSensor.function, |
- static_cast<const char *>(&input_record_[0]), kInputSize, |
- &output_record_[0], &output_size) != KERN_SUCCESS) { |
- return false; |
- } |
- |
- // Calculate per-axis calibrated values. |
- float axis_value[3]; |
- |
- for (int i = 0; i < 3; ++i) { |
- int sensor_value = 0; |
- int size = kGenericSensor.axis_size; |
- int index = sensor_->axis[i].index; |
- |
- // Important Note: Little endian is assumed as this code is Mac-only |
- // and PowerPC is currently not supported. |
- memcpy(&sensor_value, &output_record_[index], size); |
- |
- sensor_value = ExtendSign(sensor_value, size); |
- |
- // Correct value using the current calibration. |
- axis_value[i] = static_cast<float>(sensor_value - kGenericSensor.zero_g) / |
- kGenericSensor.one_g; |
- |
- // Make sure we reject any NaN or infinite values. |
- if (!isfinite(axis_value[i])) |
- return false; |
- |
- // Clamp value to the [-1, 1] range. |
- if (axis_value[i] < -1.0) |
- axis_value[i] = -1.0; |
- else if (axis_value[i] > 1.0) |
- axis_value[i] = 1.0; |
- |
- // Apply axis inversion. |
- if (sensor_->axis[i].inverted) |
- axis_value[i] = -axis_value[i]; |
- } |
- |
- // Transform the accelerometer values to W3C draft angles. |
- // |
- // Accelerometer values are just dot products of the sensor axes |
- // by the gravity vector 'g' with the result for the z axis inverted. |
- // |
- // To understand this transformation calculate the 3rd row of the z-x-y |
- // Euler angles rotation matrix (because of the 'g' vector, only 3rd row |
- // affects to the result). Note that z-x-y matrix means R = Ry * Rx * Rz. |
- // Then, assume alpha = 0 and you get this: |
- // |
- // x_acc = sin(gamma) |
- // y_acc = - cos(gamma) * sin(beta) |
- // z_acc = cos(beta) * cos(gamma) |
- // |
- // After that the rest is just a bit of trigonometry. |
- // |
- // Also note that alpha can't be provided but it's assumed to be always zero. |
- // This is necessary in order to provide enough information to solve |
- // the equations. |
- // |
- const double kRad2deg = 180.0 / M_PI; |
- |
- orientation->alpha_ = 0.0; |
- orientation->beta_ = kRad2deg * atan2(-axis_value[1], axis_value[2]); |
- orientation->gamma_ = kRad2deg * asin(axis_value[0]); |
- |
- // Make sure that the interval boundaries comply with the specification. At |
- // this point, beta is [-180, 180] and gamma is [-90, 90], but the spec has |
- // the upper bound open on both. |
- if (orientation->beta_ == 180.0) { |
- orientation->beta_ = -180.0; // -180 == 180 (upside-down) |
- } |
- if (orientation->gamma_ == 90.0) { |
- static double just_less_than_90 = nextafter(90, 0); |
- orientation->gamma_ = just_less_than_90; |
- } |
- |
- // At this point, DCHECKing is paranoia. Never hurts. |
- DCHECK_GE(orientation->beta_, -180.0); |
- DCHECK_LT(orientation->beta_, 180.0); |
- DCHECK_GE(orientation->gamma_, -90.0); |
- DCHECK_LT(orientation->gamma_, 90.0); |
- |
- orientation->can_provide_alpha_ = false; |
- orientation->can_provide_beta_ = true; |
- orientation->can_provide_gamma_ = true; |
- |
- return true; |
-} |
- |
-// Probe the local hardware looking for a supported sensor device |
-// and initialize an I/O connection to it. |
-bool AccelerometerMac::Init() { |
- // Allocate local variables for model name string (size from SMSLib). |
- static const int kNameSize = 32; |
- char local_model[kNameSize]; |
- |
- // Request model name to the kernel. |
- size_t name_size = kNameSize; |
- int params[2] = { CTL_HW, HW_MODEL }; |
- if (sysctl(params, 2, local_model, &name_size, NULL, 0) != 0) |
- return NULL; |
- |
- const SensorDescriptor* sensor_candidate = NULL; |
- |
- // Look for the current model in the supported sensor list. |
- const int kNumSensors = arraysize(kSupportedSensors); |
- |
- for (int i = 0; i < kNumSensors; ++i) { |
- // Check if the supported sensor model name is a prefix |
- // of the local hardware model (empty names are accepted). |
- const char* p1 = kSupportedSensors[i].model_name; |
- for (const char* p2 = local_model; *p1 != '\0' && *p1 == *p2; ++p1, ++p2) |
- continue; |
- if (*p1 != '\0') |
- continue; |
- |
- // Local hardware found in the supported sensor list. |
- sensor_candidate = &kSupportedSensors[i]; |
- |
- // Get a dictionary of the services matching to the one in the sensor. |
- CFMutableDictionaryRef dict = |
- IOServiceMatching(kGenericSensor.service_name); |
- if (dict == NULL) |
- continue; |
- |
- // Get an iterator for the matching services. |
- io_iterator_t device_iterator; |
- if (IOServiceGetMatchingServices(kIOMasterPortDefault, dict, |
- &device_iterator) != KERN_SUCCESS) { |
- continue; |
- } |
- |
- // Get the first device in the list. |
- io_object_t device = IOIteratorNext(device_iterator); |
- IOObjectRelease(device_iterator); |
- if (device == 0) |
- continue; |
- |
- // Try to open device. |
- kern_return_t result; |
- result = IOServiceOpen(device, mach_task_self(), 0, &io_connection_); |
- IOObjectRelease(device); |
- if (result != KERN_SUCCESS || io_connection_ == 0) |
- return false; |
- |
- // Local sensor service confirmed by IOKit. |
- sensor_ = sensor_candidate; |
- break; |
- } |
- |
- if (sensor_ == NULL) |
- return false; |
- |
- // Allocate and initialize input/output records. |
- input_record_.resize(kGenericSensor.record_size, 0x01); |
- output_record_.resize(kGenericSensor.record_size, 0x00); |
- |
- // Try to retrieve the current orientation. |
- Orientation test_orientation; |
- return GetOrientation(&test_orientation); |
-} |
- |
-// Extend the sign of an integer of less than 32 bits to a 32-bit integer. |
-int AccelerometerMac::ExtendSign(int value, size_t size) { |
- switch (size) { |
- case 1: |
- if (value & 0x00000080) |
- return value | 0xffffff00; |
- break; |
- |
- case 2: |
- if (value & 0x00008000) |
- return value | 0xffff0000; |
- break; |
- |
- case 3: |
- if (value & 0x00800000) |
- return value | 0xff000000; |
- break; |
- |
- default: |
- LOG(FATAL) << "Invalid integer size for sign extension: " << size; |
- } |
- |
- return value; |
-} |
- |
-} // namespace device_orientation |