132 lines
4.0 KiB
C++
132 lines
4.0 KiB
C++
/*
|
|
* Copyright (C) 2019 The LineageOS Project
|
|
*
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
* you may not use this file except in compliance with the License.
|
|
* You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
* See the License for the specific language governing permissions and
|
|
* limitations under the License.
|
|
*/
|
|
|
|
#define LOG_TAG "CameraMotorService"
|
|
|
|
#include "CameraMotor.h"
|
|
#include <android-base/logging.h>
|
|
#include <hidl/HidlTransportSupport.h>
|
|
#include <chrono>
|
|
#include <fstream>
|
|
#include <thread>
|
|
|
|
#define CAMERA_MOTOR_ENABLE "/sys/devices/platform/vendor/vendor:motor_pl/enable"
|
|
#define CAMERA_MOTOR_DIRECTION "/sys/devices/platform/vendor/vendor:motor_pl/direction"
|
|
#define CAMERA_MOTOR_HALL_CALIBRATION "/sys/bus/platform/devices/vendor:motor_pl/hall_calibration"
|
|
#define CAMERA_MOTOR_POSITION "/sys/devices/platform/vendor/vendor:motor_pl/position"
|
|
#define CAMERA_PERSIST_HALL_CALIBRATION "/mnt/vendor/persist/engineermode/hall_calibration"
|
|
#define DIRECTION_DOWN "0"
|
|
#define DIRECTION_UP "1"
|
|
#define HALL_CALIBRATION_DEFAULT "170,170,480,0,0,480,500,0,0,500,1500"
|
|
#define POSITION_DOWN "1"
|
|
#define POSITION_UP "0"
|
|
#define ENABLED "1"
|
|
#define CAMERA_ID_FRONT "1"
|
|
|
|
namespace vendor {
|
|
namespace lineage {
|
|
namespace camera {
|
|
namespace motor {
|
|
namespace V1_0 {
|
|
namespace implementation {
|
|
|
|
using namespace std::chrono_literals;
|
|
|
|
/*
|
|
* Write value to path and close file.
|
|
*/
|
|
template <typename T>
|
|
static void set(const std::string& path, const T& value) {
|
|
std::ofstream file(path);
|
|
file << value;
|
|
}
|
|
|
|
template <typename T>
|
|
static T get(const std::string& path, const T& def) {
|
|
std::ifstream file(path);
|
|
T result;
|
|
|
|
file >> result;
|
|
return file.fail() ? def : result;
|
|
}
|
|
|
|
static void waitUntilFileChange(const std::string& path, const std::string &val,
|
|
const std::chrono::milliseconds relativeTimeout) {
|
|
auto startTime = std::chrono::steady_clock::now();
|
|
|
|
while (true) {
|
|
if (get<std::string>(path, "") == val) {
|
|
return;
|
|
}
|
|
|
|
std::this_thread::sleep_for(50ms);
|
|
|
|
auto now = std::chrono::steady_clock::now();
|
|
auto timeElapsed = std::chrono::duration_cast<std::chrono::milliseconds>(now - startTime);
|
|
|
|
if (timeElapsed > relativeTimeout) {
|
|
return;
|
|
}
|
|
}
|
|
}
|
|
|
|
CameraMotor::CameraMotor() {
|
|
// Load motor hall calibration data
|
|
set(CAMERA_MOTOR_HALL_CALIBRATION,
|
|
get<std::string>(CAMERA_PERSIST_HALL_CALIBRATION, HALL_CALIBRATION_DEFAULT));
|
|
}
|
|
|
|
Return<void> CameraMotor::onConnect(const hidl_string& cameraId) {
|
|
auto motorPosition = get<std::string>(CAMERA_MOTOR_POSITION, "");
|
|
|
|
if (cameraId == CAMERA_ID_FRONT && motorPosition == POSITION_DOWN) {
|
|
LOG(INFO) << "Popping out front camera";
|
|
|
|
set(CAMERA_MOTOR_DIRECTION, DIRECTION_UP);
|
|
set(CAMERA_MOTOR_ENABLE, ENABLED);
|
|
waitUntilFileChange(CAMERA_MOTOR_POSITION, POSITION_UP, 5s);
|
|
} else if (cameraId != CAMERA_ID_FRONT && motorPosition == POSITION_UP) {
|
|
LOG(INFO) << "Retracting front camera";
|
|
|
|
set(CAMERA_MOTOR_DIRECTION, DIRECTION_DOWN);
|
|
set(CAMERA_MOTOR_ENABLE, ENABLED);
|
|
waitUntilFileChange(CAMERA_MOTOR_POSITION, POSITION_DOWN, 5s);
|
|
}
|
|
|
|
return Void();
|
|
}
|
|
|
|
Return<void> CameraMotor::onDisconnect(const hidl_string& cameraId) {
|
|
auto motorPosition = get<std::string>(CAMERA_MOTOR_POSITION, "");
|
|
|
|
if (cameraId == CAMERA_ID_FRONT && motorPosition == POSITION_UP) {
|
|
LOG(INFO) << "Retracting front camera";
|
|
|
|
set(CAMERA_MOTOR_DIRECTION, DIRECTION_DOWN);
|
|
set(CAMERA_MOTOR_ENABLE, ENABLED);
|
|
waitUntilFileChange(CAMERA_MOTOR_POSITION, POSITION_DOWN, 5s);
|
|
}
|
|
|
|
return Void();
|
|
}
|
|
|
|
} // namespace implementation
|
|
} // namespace V1_0
|
|
} // namespace motor
|
|
} // namespace camera
|
|
} // namespace lineage
|
|
} // namespace vendor
|