sdm845-common: Add power hal
Change-Id: I764cccb93b01ea2bfaca4cfe93ac314b7c680d5d
This commit is contained in:
Luca Stefani
224
power/power-845.c
Normal file
224
power/power-845.c
Normal file
@@ -0,0 +1,224 @@
|
||||
/*
|
||||
* Copyright (c) 2017, The Linux Foundation. All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions are
|
||||
* met:
|
||||
* * * Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions and the following disclaimer.
|
||||
* * Redistributions in binary form must reproduce the above
|
||||
* copyright notice, this list of conditions and the following
|
||||
* disclaimer in the documentation and/or other materials provided
|
||||
* with the distribution.
|
||||
* * Neither the name of The Linux Foundation nor the names of its
|
||||
* contributors may be used to endorse or promote products derived
|
||||
* from this software without specific prior written permission.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
|
||||
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
|
||||
* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
|
||||
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||||
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||||
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
|
||||
* BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
|
||||
* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
|
||||
* OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
|
||||
* IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||
*/
|
||||
|
||||
#define LOG_NIDEBUG 0
|
||||
|
||||
#include <dlfcn.h>
|
||||
#include <errno.h>
|
||||
#include <fcntl.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include <sys/stat.h>
|
||||
#include <sys/types.h>
|
||||
|
||||
#define LOG_TAG "QTI PowerHAL"
|
||||
#include <hardware/hardware.h>
|
||||
#include <hardware/power.h>
|
||||
#include <utils/Log.h>
|
||||
|
||||
#include "hint-data.h"
|
||||
#include "metadata-defs.h"
|
||||
#include "performance.h"
|
||||
#include "power-common.h"
|
||||
#include "utils.h"
|
||||
|
||||
#define CHECK_HANDLE(x) ((x) > 0)
|
||||
#define NUM_PERF_MODES 3
|
||||
|
||||
typedef enum {
|
||||
NORMAL_MODE = 0,
|
||||
SUSTAINED_MODE = 1,
|
||||
VR_MODE = 2,
|
||||
VR_SUSTAINED_MODE = (SUSTAINED_MODE | VR_MODE),
|
||||
INVALID_MODE = 0xFF
|
||||
} perf_mode_type_t;
|
||||
|
||||
typedef struct perf_mode {
|
||||
perf_mode_type_t type;
|
||||
int perf_hint_id;
|
||||
} perf_mode_t;
|
||||
|
||||
perf_mode_t perf_modes[NUM_PERF_MODES] = {{SUSTAINED_MODE, SUSTAINED_PERF_HINT},
|
||||
{VR_MODE, VR_MODE_HINT},
|
||||
{VR_SUSTAINED_MODE, VR_MODE_SUSTAINED_PERF_HINT}};
|
||||
|
||||
static pthread_mutex_t perf_mode_switch_lock = PTHREAD_MUTEX_INITIALIZER;
|
||||
static int current_mode = NORMAL_MODE;
|
||||
|
||||
static inline int get_perfd_hint_id(perf_mode_type_t type) {
|
||||
int i;
|
||||
for (i = 0; i < NUM_PERF_MODES; i++) {
|
||||
if (perf_modes[i].type == type) {
|
||||
ALOGD("Hint id is 0x%x for mode 0x%x", perf_modes[i].perf_hint_id, type);
|
||||
return perf_modes[i].perf_hint_id;
|
||||
}
|
||||
}
|
||||
ALOGD("Couldn't find the hint for mode 0x%x", type);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int switch_mode(perf_mode_type_t mode) {
|
||||
int hint_id = 0;
|
||||
static int perfd_mode_handle = -1;
|
||||
|
||||
// release existing mode if any
|
||||
if (CHECK_HANDLE(perfd_mode_handle)) {
|
||||
ALOGD("Releasing handle 0x%x", perfd_mode_handle);
|
||||
release_request(perfd_mode_handle);
|
||||
perfd_mode_handle = -1;
|
||||
}
|
||||
// switch to a perf mode
|
||||
hint_id = get_perfd_hint_id(mode);
|
||||
if (hint_id != 0) {
|
||||
perfd_mode_handle = perf_hint_enable(hint_id, 0);
|
||||
if (!CHECK_HANDLE(perfd_mode_handle)) {
|
||||
ALOGE("Failed perf_hint_interaction for mode: 0x%x", mode);
|
||||
return -1;
|
||||
}
|
||||
ALOGD("Acquired handle 0x%x", perfd_mode_handle);
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int process_perf_hint(void* data, perf_mode_type_t mode) {
|
||||
pthread_mutex_lock(&perf_mode_switch_lock);
|
||||
|
||||
// enable
|
||||
if (data) {
|
||||
ALOGI("Enable request for mode: 0x%x", mode);
|
||||
// check if mode is current mode
|
||||
if (current_mode & mode) {
|
||||
pthread_mutex_unlock(&perf_mode_switch_lock);
|
||||
ALOGD("Mode 0x%x already enabled", mode);
|
||||
return HINT_HANDLED;
|
||||
}
|
||||
// enable requested mode
|
||||
if (0 != switch_mode(current_mode | mode)) {
|
||||
pthread_mutex_unlock(&perf_mode_switch_lock);
|
||||
ALOGE("Couldn't enable mode 0x%x", mode);
|
||||
return HINT_NONE;
|
||||
}
|
||||
current_mode |= mode;
|
||||
ALOGI("Current mode is 0x%x", current_mode);
|
||||
// disable
|
||||
} else {
|
||||
ALOGI("Disable request for mode: 0x%x", mode);
|
||||
// check if mode is enabled
|
||||
if (!(current_mode & mode)) {
|
||||
pthread_mutex_unlock(&perf_mode_switch_lock);
|
||||
ALOGD("Mode 0x%x already disabled", mode);
|
||||
return HINT_HANDLED;
|
||||
}
|
||||
// disable requested mode
|
||||
if (0 != switch_mode(current_mode & ~mode)) {
|
||||
pthread_mutex_unlock(&perf_mode_switch_lock);
|
||||
ALOGE("Couldn't disable mode 0x%x", mode);
|
||||
return HINT_NONE;
|
||||
}
|
||||
current_mode &= ~mode;
|
||||
ALOGI("Current mode is 0x%x", current_mode);
|
||||
}
|
||||
|
||||
pthread_mutex_unlock(&perf_mode_switch_lock);
|
||||
return HINT_HANDLED;
|
||||
}
|
||||
|
||||
static int process_video_encode_hint(void* metadata) {
|
||||
char governor[80];
|
||||
struct video_encode_metadata_t video_encode_metadata;
|
||||
static int video_encode_handle = 0;
|
||||
|
||||
if (!metadata) return HINT_NONE;
|
||||
|
||||
if (get_scaling_governor(governor, sizeof(governor)) == -1) {
|
||||
ALOGE("Can't obtain scaling governor.");
|
||||
|
||||
return HINT_NONE;
|
||||
}
|
||||
|
||||
/* Initialize encode metadata struct fields */
|
||||
memset(&video_encode_metadata, 0, sizeof(struct video_encode_metadata_t));
|
||||
video_encode_metadata.state = -1;
|
||||
|
||||
if (parse_video_encode_metadata((char*)metadata, &video_encode_metadata) == -1) {
|
||||
ALOGE("Error occurred while parsing metadata.");
|
||||
return HINT_NONE;
|
||||
}
|
||||
|
||||
if (video_encode_metadata.state == 1) {
|
||||
if (is_interactive_governor(governor)) {
|
||||
video_encode_handle = perf_hint_enable(VIDEO_ENCODE_HINT, 0);
|
||||
ALOGI("Video encode hint start");
|
||||
return HINT_HANDLED;
|
||||
}
|
||||
} else if (video_encode_metadata.state == 0) {
|
||||
if (is_interactive_governor(governor)) {
|
||||
release_request(video_encode_handle);
|
||||
ALOGI("Video Encode hint stop");
|
||||
return HINT_HANDLED;
|
||||
}
|
||||
}
|
||||
return HINT_NONE;
|
||||
}
|
||||
|
||||
/* Declare function before use */
|
||||
void interaction(int duration, int num_args, int opt_list[]);
|
||||
|
||||
int power_hint_override(struct power_module* module, power_hint_t hint, void* data) {
|
||||
int ret_val = HINT_NONE;
|
||||
switch (hint) {
|
||||
case POWER_HINT_VIDEO_ENCODE:
|
||||
ret_val = process_video_encode_hint(data);
|
||||
break;
|
||||
case POWER_HINT_SUSTAINED_PERFORMANCE:
|
||||
ret_val = process_perf_hint(data, SUSTAINED_MODE);
|
||||
break;
|
||||
case POWER_HINT_VR_MODE:
|
||||
ret_val = process_perf_hint(data, VR_MODE);
|
||||
break;
|
||||
case POWER_HINT_INTERACTION: {
|
||||
int resources[] = {0x40800100, 0x514};
|
||||
int duration = 100;
|
||||
interaction(duration, sizeof(resources) / sizeof(resources[0]), resources);
|
||||
ret_val = HINT_HANDLED;
|
||||
} break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
return ret_val;
|
||||
}
|
||||
|
||||
int set_interactive_override(struct power_module* module, int on) {
|
||||
static int set_i_count = 0;
|
||||
|
||||
set_i_count++;
|
||||
ALOGI("Got set_interactive hint on= %d, count= %d\n", on, set_i_count);
|
||||
|
||||
return HINT_HANDLED; /* Don't excecute this code path, not in use */
|
||||
}
|
||||
Reference in New Issue
Block a user