diff options
author | jam@chromium.org <jam@chromium.org@0039d316-1c4b-4281-b951-d872f2087c98> | 2011-02-24 23:37:35 +0000 |
---|---|---|
committer | jam@chromium.org <jam@chromium.org@0039d316-1c4b-4281-b951-d872f2087c98> | 2011-02-24 23:37:35 +0000 |
commit | 1eaa4f7c5ad1d08be49cea5b2c3c6cd64b5e2e1c (patch) | |
tree | 7e91b52608eac0a555856908c588b529caa58965 /content/browser/device_orientation/accelerometer_mac.cc | |
parent | fbf3ff838fb1dbe7493c4df4c0a619f6c406682d (diff) | |
download | chromium_src-1eaa4f7c5ad1d08be49cea5b2c3c6cd64b5e2e1c.zip chromium_src-1eaa4f7c5ad1d08be49cea5b2c3c6cd64b5e2e1c.tar.gz chromium_src-1eaa4f7c5ad1d08be49cea5b2c3c6cd64b5e2e1c.tar.bz2 |
Move appcache/file_sytem/device_orientation subdirectories of chrome\browser to content\browser.
TBR=avi
Review URL: http://codereview.chromium.org/6586001
git-svn-id: svn://svn.chromium.org/chrome/trunk/src@75990 0039d316-1c4b-4281-b951-d872f2087c98
Diffstat (limited to 'content/browser/device_orientation/accelerometer_mac.cc')
-rw-r--r-- | content/browser/device_orientation/accelerometer_mac.cc | 412 |
1 files changed, 412 insertions, 0 deletions
diff --git a/content/browser/device_orientation/accelerometer_mac.cc b/content/browser/device_orientation/accelerometer_mac.cc new file mode 100644 index 0000000..f642212 --- /dev/null +++ b/content/browser/device_orientation/accelerometer_mac.cc @@ -0,0 +1,412 @@ +// 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 "content/browser/device_orientation/accelerometer_mac.h" + +#include <math.h> +#include <sys/sysctl.h> + +#include "base/logging.h" +#include "base/scoped_ptr.h" +#include "content/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 |