audio/audio_route.c - fp2-dev/device/samsung/manta - Gitiles

 /*
  * Copyright (C) 2012 The Android Open Source Project
  * Inspired by TinyHW, written by Mark Brown at Wolfson Micro
  *
  * 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 "audio_hw_primary"
 /*#define LOG_NDEBUG 0*/

 #include <errno.h>
 #include <expat.h>
 #include <stdbool.h>
 #include <stdio.h>

 #include <cutils/log.h>
 #include <cutils/properties.h>

 #include <tinyalsa/asoundlib.h>

 #define BUF_SIZE 1024
 #define MIXER_XML_PATH "/system/etc/mixer_paths.xml"
 #define INITIAL_MIXER_PATH_SIZE 8

 #define MIXER_CARD 0

 struct mixer_state {
     struct mixer_ctl *ctl;
     unsigned int num_values;
     int *old_value;
     int *new_value;
     int *reset_value;
     /* If linked is true, only the first element in each array is valid */
     bool old_linked;
     bool new_linked;
     bool reset_linked;
 };

 struct mixer_setting {
     struct mixer_ctl *ctl;
     unsigned int num_values;
     int *value;
     /* If linked is true, only the first element in each array is valid */
     bool linked;
 };

 struct mixer_value {
     struct mixer_ctl *ctl;
     int index;
     int value;
 };

 struct mixer_path {
     char *name;
     unsigned int size;
     unsigned int length;
     struct mixer_setting *setting;
 };

 struct audio_route {
     struct mixer *mixer;
     unsigned int num_mixer_ctls;
     struct mixer_state *mixer_state;

     unsigned int mixer_path_size;
     unsigned int num_mixer_paths;
     struct mixer_path *mixer_path;
 };

 struct config_parse_state {
     struct audio_route *ar;
     struct mixer_path *path;
     int level;
 };

 /* path functions */

 static void path_print(struct mixer_path *path)
 {
     unsigned int i;
     unsigned int j;

     ALOGE("Path: %s, length: %d", path->name, path->length);
     for (i = 0; i < path->length; i++) {
         ALOGE("  id=%d: ctl=%s linked=%c", i,
               mixer_ctl_get_name(path->setting[i].ctl),
               path->setting[i].linked ? 'y' : 'n');
         for (j = 0; j < path->setting[i].num_values; j++)
             ALOGE("    id=%d value=%d", j, path->setting[i].value[j]);
     }
 }

 static void path_free(struct audio_route *ar)
 {
     unsigned int i;

     for (i = 0; i < ar->num_mixer_paths; i++) {
         if (ar->mixer_path[i].name)
             free(ar->mixer_path[i].name);
         if (ar->mixer_path[i].setting) {
             if (ar->mixer_path[i].setting->value)
                 free(ar->mixer_path[i].setting->value);
             free(ar->mixer_path[i].setting);
         }
     }
     free(ar->mixer_path);
 }

 static struct mixer_path *path_get_by_name(struct audio_route *ar,
                                            const char *name)
 {
     unsigned int i;

     for (i = 0; i < ar->num_mixer_paths; i++)
         if (strcmp(ar->mixer_path[i].name, name) == 0)
             return &ar->mixer_path[i];

     return NULL;
 }

 static struct mixer_path *path_create(struct audio_route *ar, const char *name)
 {
     struct mixer_path *new_mixer_path = NULL;

     if (path_get_by_name(ar, name)) {
         ALOGE("Path name '%s' already exists", name);
         return NULL;
     }

     /* check if we need to allocate more space for mixer paths */
     if (ar->mixer_path_size <= ar->num_mixer_paths) {
         if (ar->mixer_path_size == 0)
             ar->mixer_path_size = INITIAL_MIXER_PATH_SIZE;
         else
             ar->mixer_path_size *= 2;

         new_mixer_path = realloc(ar->mixer_path, ar->mixer_path_size *
                                  sizeof(struct mixer_path));
         if (new_mixer_path == NULL) {
             ALOGE("Unable to allocate more paths");
             return NULL;
         } else {
             ar->mixer_path = new_mixer_path;
         }
     }

     /* initialise the new mixer path */
     ar->mixer_path[ar->num_mixer_paths].name = strdup(name);
     ar->mixer_path[ar->num_mixer_paths].size = 0;
     ar->mixer_path[ar->num_mixer_paths].length = 0;
     ar->mixer_path[ar->num_mixer_paths].setting = NULL;

     /* return the mixer path just added, then increment number of them */
     return &ar->mixer_path[ar->num_mixer_paths++];
 }

 static int find_ctl_in_path(struct mixer_path *path, struct mixer_ctl *ctl)
 {
     unsigned int i;

     for (i = 0; i < path->length; i++)
         if (path->setting[i].ctl == ctl)
             return i;

     return -1;
 }

 static int alloc_path_setting(struct mixer_path *path)
 {
     struct mixer_setting *new_path_setting;
     int path_index;

     /* check if we need to allocate more space for path settings */
     if (path->size <= path->length) {
         if (path->size == 0)
             path->size = INITIAL_MIXER_PATH_SIZE;
         else
             path->size *= 2;

         new_path_setting = realloc(path->setting,
                                    path->size * sizeof(struct mixer_setting));
         if (new_path_setting == NULL) {
             ALOGE("Unable to allocate more path settings");
             return -1;
         } else {
             path->setting = new_path_setting;
         }
     }

     path_index = path->length;
     path->length++;

     return path_index;
 }

 static int path_add_setting(struct mixer_path *path,
                             struct mixer_setting *setting)
 {
     unsigned int i;
     int path_index;

     if (find_ctl_in_path(path, setting->ctl) != -1) {
         ALOGE("Control '%s' already exists in path '%s'",
               mixer_ctl_get_name(setting->ctl), path->name);
         return -1;
     }

     path_index = alloc_path_setting(path);
     if (path_index < 0)
         return -1;

     path->setting[path_index].ctl = setting->ctl;
     path->setting[path_index].num_values = setting->num_values;
     path->setting[path_index].value = malloc(setting->num_values * sizeof(int));
     path->setting[path_index].linked = setting->linked;
     if (setting->linked) {
         path->setting[path_index].value[0] = setting->value[0];
     } else {
         for (i = 0; i < setting->num_values; i++)
             path->setting[path_index].value[i] = setting->value[i];
     }

     return 0;
 }

 static int path_add_value(struct mixer_path *path,
                           struct mixer_value *mixer_value)
 {
     unsigned int i;
     int path_index;
     unsigned int num_values;

     /* Check that mixer value index is within range */
     num_values = mixer_ctl_get_num_values(mixer_value->ctl);
     if (mixer_value->index >= (int)num_values) {
         ALOGE("mixer index %d is out of range for '%s'", mixer_value->index,
               mixer_ctl_get_name(mixer_value->ctl));
         return -1;
     }

     path_index = find_ctl_in_path(path, mixer_value->ctl);
     if (path_index < 0) {
         /* New path */

         path_index = alloc_path_setting(path);
         if (path_index < 0)
             return -1;

         /* initialise the new path setting */
         path->setting[path_index].ctl = mixer_value->ctl;
         path->setting[path_index].num_values = num_values;
         path->setting[path_index].value = malloc(num_values * sizeof(int));
     }

     if (mixer_value->index == -1) {
         /* Linked, so only set the first value */
         path->setting[path_index].linked = true;
         path->setting[path_index].value[0] = mixer_value->value;
     } else {
         if (path->setting[path_index].linked && (num_values > 1)) {
             /* Unlinking the values, so duplicate them across */
             for (i = 1; i < num_values; i++) {
                 path->setting[path_index].value[i] =
                         path->setting[path_index].value[0];
             }
             path->setting[path_index].linked = false;
         }
         path->setting[path_index].value[mixer_value->index] = mixer_value->value;
     }

     return 0;
 }

 static int path_add_path(struct mixer_path *path, struct mixer_path *sub_path)
 {
     unsigned int i;

     for (i = 0; i < sub_path->length; i++)
         if (path_add_setting(path, &sub_path->setting[i]) < 0)
             return -1;

     return 0;
 }

 static int path_apply(struct audio_route *ar, struct mixer_path *path)
 {
     unsigned int i;
     unsigned int j;
     unsigned int ctl_index;

     for (i = 0; i < path->length; i++) {
         struct mixer_ctl *ctl = path->setting[i].ctl;

         /* locate the mixer ctl in the list */
         for (ctl_index = 0; ctl_index < ar->num_mixer_ctls; ctl_index++)
             if (ar->mixer_state[ctl_index].ctl == ctl)
                 break;

         /* apply the new value(s) */
         for (j = 0; j < ar->mixer_state[ctl_index].num_values; j++) {
             ar->mixer_state[ctl_index].new_value[j] = path->setting[i].value[j];
             if (path->setting[i].linked)
                 break;
         }
         ar->mixer_state[ctl_index].new_linked = path->setting[i].linked;
     }

     return 0;
 }

 /* mixer helper function */
 static int mixer_enum_string_to_value(struct mixer_ctl *ctl, const char *string)
 {
     unsigned int i;

     /* Search the enum strings for a particular one */
     for (i = 0; i < mixer_ctl_get_num_enums(ctl); i++) {
         if (strcmp(mixer_ctl_get_enum_string(ctl, i), string) == 0)
             break;
     }

     return i;
 }

 static void start_tag(void *data, const XML_Char *tag_name,
                       const XML_Char **attr)
 {
     const XML_Char *attr_name = NULL;
     const XML_Char *attr_id = NULL;
     const XML_Char *attr_value = NULL;
     struct config_parse_state *state = data;
     struct audio_route *ar = state->ar;
     unsigned int i;
     unsigned int ctl_index;
     struct mixer_ctl *ctl;
     int value;
     unsigned int id;
     struct mixer_value mixer_value;

     /* Get name, id and value attributes (these may be empty) */
     for (i = 0; attr[i]; i += 2) {
         if (strcmp(attr[i], "name") == 0)
             attr_name = attr[i + 1];
         if (strcmp(attr[i], "id") == 0)
             attr_id = attr[i + 1];
         else if (strcmp(attr[i], "value") == 0)
             attr_value = attr[i + 1];
     }

     /* Look at tags */
     if (strcmp(tag_name, "path") == 0) {
         if (attr_name == NULL) {
             ALOGE("Unnamed path!");
         } else {
             if (state->level == 1) {
                 /* top level path: create and stash the path */
                 state->path = path_create(ar, (char *)attr_name);
             } else {
                 /* nested path */
                 struct mixer_path *sub_path = path_get_by_name(ar, attr_name);
                 path_add_path(state->path, sub_path);
             }
         }
     }

     else if (strcmp(tag_name, "ctl") == 0) {
         /* Obtain the mixer ctl and value */
         ctl = mixer_get_ctl_by_name(ar->mixer, attr_name);
         switch (mixer_ctl_get_type(ctl)) {
         case MIXER_CTL_TYPE_BOOL:
         case MIXER_CTL_TYPE_INT:
             value = atoi((char *)attr_value);
             break;
         case MIXER_CTL_TYPE_ENUM:
             value = mixer_enum_string_to_value(ctl, (char *)attr_value);
             break;
         default:
             value = 0;
             break;
         }

         if (state->level == 1) {
             /* top level ctl (initial setting) */

             /* locate the mixer ctl in the list */
             for (ctl_index = 0; ctl_index < ar->num_mixer_ctls; ctl_index++) {
                 if (ar->mixer_state[ctl_index].ctl == ctl)
                     break;
             }

             /* apply the new value */
             if (attr_id) {
                 /* set only one value */
                 id = atoi((char *)attr_id);
                 if (id < ar->mixer_state[ctl_index].num_values) {
                     /*
                      * We're unlinking the values, so copy old_value[0] into
                      * all the new_value elements.
                      */
                     for (i = 0; i < ar->mixer_state[ctl_index].num_values; i++) {
                         ar->mixer_state[ctl_index].new_value[i] =
                                 ar->mixer_state[ctl_index].old_value[0];
                     }
                     ar->mixer_state[ctl_index].new_linked = false;
                     ar->mixer_state[ctl_index].new_value[id] = value;
                 } else {
                     ALOGE("value id out of range for mixer ctl '%s'",
                           mixer_ctl_get_name(ctl));
                 }
             } else {
                 ar->mixer_state[ctl_index].new_value[0] = value;
                 ar->mixer_state[ctl_index].new_linked = true;
             }
         } else {
             /* nested ctl (within a path) */
             mixer_value.ctl = ctl;
             mixer_value.value = value;
             if (attr_id)
                 mixer_value.index = atoi((char *)attr_id);
             else
                 mixer_value.index = -1;
             path_add_value(state->path, &mixer_value);
         }
     }

     state->level++;
 }

 static void end_tag(void *data, const XML_Char *tag_name)
 {
     struct config_parse_state *state = data;

     state->level--;
 }

 static int alloc_mixer_state(struct audio_route *ar)
 {
     unsigned int i;
     unsigned int j;
     unsigned int num_values;
     struct mixer_ctl *ctl;
     bool linked;

     ar->num_mixer_ctls = mixer_get_num_ctls(ar->mixer);
     ar->mixer_state = malloc(ar->num_mixer_ctls * sizeof(struct mixer_state));
     if (!ar->mixer_state)
         return -1;

     for (i = 0; i < ar->num_mixer_ctls; i++) {
         ctl = mixer_get_ctl(ar->mixer, i);
         num_values = mixer_ctl_get_num_values(ctl);

         ar->mixer_state[i].old_value = malloc(num_values * sizeof(int));
         ar->mixer_state[i].new_value = malloc(num_values * sizeof(int));
         ar->mixer_state[i].reset_value = malloc(num_values * sizeof(int));

         /*
          * Get all mixer values for controls with multiple values. If all
          * values are the same, set the linked flag.
          */
         linked = true;
         for (j = 0; j < num_values; j++) {
             ar->mixer_state[i].old_value[j] = mixer_ctl_get_value(ctl, j);
             ar->mixer_state[i].new_value[j] = ar->mixer_state[i].old_value[j];

             /*
              * If the next value is different from the last, set linked to
              * false.
              */
             if ((j > 0) && (ar->mixer_state[i].old_value[j - 1] !=
                             ar->mixer_state[i].old_value[j])) {
                 linked = false;
             }
         }
         ar->mixer_state[i].ctl = ctl;
         ar->mixer_state[i].old_linked = linked;
         ar->mixer_state[i].new_linked = linked;
         ar->mixer_state[i].num_values = num_values;
     }

     return 0;
 }

 static void free_mixer_state(struct audio_route *ar)
 {
     unsigned int i;

     for (i = 0; i < ar->num_mixer_ctls; i++) {
         free(ar->mixer_state[i].old_value);
         free(ar->mixer_state[i].new_value);
         free(ar->mixer_state[i].reset_value);
     }

     free(ar->mixer_state);
     ar->mixer_state = NULL;
 }

 void update_mixer_state(struct audio_route *ar)
 {
     unsigned int i;
     unsigned int j;

     for (i = 0; i < ar->num_mixer_ctls; i++) {
         unsigned int num_values = ar->mixer_state[i].num_values;

         /* if the value has changed, update the mixer */
         if (ar->mixer_state[i].new_linked) {
             if (ar->mixer_state[i].old_value[0] != ar->mixer_state[i].new_value[0]) {
                 /* linked ctl, so set all ctl values the same */
                 for (j = 0; j < num_values; j++)
                     mixer_ctl_set_value(ar->mixer_state[i].ctl, j,
                                         ar->mixer_state[i].new_value[0]);
                 ar->mixer_state[i].old_value[0] = ar->mixer_state[i].new_value[0];
             }
         } else {
             for (j = 0; j < num_values; j++) {
                 /* unlinked ctl, so set each value if necessary */
                 if (ar->mixer_state[i].old_value[j] != ar->mixer_state[i].new_value[j]) {
                     mixer_ctl_set_value(ar->mixer_state[i].ctl, j,
                                         ar->mixer_state[i].new_value[j]);
                     ar->mixer_state[i].old_value[j] = ar->mixer_state[i].new_value[j];
                 }
             }
         }
         ar->mixer_state[i].old_linked = ar->mixer_state[i].new_linked;
     }
 }

 /* saves the current state of the mixer, for resetting all controls */
 static void save_mixer_state(struct audio_route *ar)
 {
     unsigned int i;
     unsigned int j;

     for (i = 0; i < ar->num_mixer_ctls; i++) {
         for (j = 0; j < ar->mixer_state[i].num_values; j++) {
             ar->mixer_state[i].reset_value[j] = ar->mixer_state[i].new_value[j];

             /* if the values are linked, only need to save value 0 */
             if (ar->mixer_state[i].new_linked)
                 break;
         }
         ar->mixer_state[i].reset_linked = ar->mixer_state[i].new_linked;
     }
 }

 /* this resets all mixer settings to the saved values */
 void reset_mixer_state(struct audio_route *ar)
 {
     unsigned int i;
     unsigned int j;

     /* load all of the saved values */
     for (i = 0; i < ar->num_mixer_ctls; i++) {
         for (j = 0; j < ar->mixer_state[i].num_values; j++) {
             ar->mixer_state[i].new_value[j] = ar->mixer_state[i].reset_value[j];

             /* if the values are linked, only need to save value 0 */
             if (ar->mixer_state[i].reset_linked)
                 break;
         }
         ar->mixer_state[i].new_linked = ar->mixer_state[i].reset_linked;
     }
 }

 void audio_route_apply_path(struct audio_route *ar, const char *name)
 {
     struct mixer_path *path;

     if (!ar) {
         ALOGE("invalid audio_route");
         return;
     }

     path = path_get_by_name(ar, name);
     if (!path) {
         ALOGE("unable to find path '%s'", name);
         return;
     }

     path_apply(ar, path);
 }

 struct audio_route *audio_route_init(void)
 {
     struct config_parse_state state;
     XML_Parser parser;
     FILE *file;
     int bytes_read;
     void *buf;
     int i;
     struct mixer_path *path;
     struct audio_route *ar;
     /* TODO remove when lunchbox is deprecated */
     char property[PROPERTY_VALUE_MAX];
     int hw_revision;

     property_get("ro.revision", property, "1");
     hw_revision = atoi(property);

     ar = calloc(1, sizeof(struct audio_route));
     if (!ar)
         goto err_calloc;

     ar->mixer = mixer_open(MIXER_CARD);
     if (!ar->mixer) {
         ALOGE("Unable to open the mixer, aborting.");
         goto err_mixer_open;
     }

     ar->mixer_path = NULL;
     ar->mixer_path_size = 0;
     ar->num_mixer_paths = 0;

     /* allocate space for and read current mixer settings */
     if (alloc_mixer_state(ar) < 0)
         goto err_mixer_state;

     /* TODO remove when lunchbox is deprecated */
     if (hw_revision == 1)
         file = fopen("/system/etc/mixer_paths_lb.xml", "r");
     else
         file = fopen(MIXER_XML_PATH, "r");

     if (!file) {
         ALOGE("Failed to open %s", MIXER_XML_PATH);
         goto err_fopen;
     }

     parser = XML_ParserCreate(NULL);
     if (!parser) {
         ALOGE("Failed to create XML parser");
         goto err_parser_create;
     }

     memset(&state, 0, sizeof(state));
     state.ar = ar;
     XML_SetUserData(parser, &state);
     XML_SetElementHandler(parser, start_tag, end_tag);

     for (;;) {
         buf = XML_GetBuffer(parser, BUF_SIZE);
         if (buf == NULL)
             goto err_parse;

         bytes_read = fread(buf, 1, BUF_SIZE, file);
         if (bytes_read < 0)
             goto err_parse;

         if (XML_ParseBuffer(parser, bytes_read,
                             bytes_read == 0) == XML_STATUS_ERROR) {
             ALOGE("Error in mixer xml (%s)", MIXER_XML_PATH);
             goto err_parse;
         }

         if (bytes_read == 0)
             break;
     }

     /* apply the initial mixer values, and save them so we can reset the
        mixer to the original values */
     update_mixer_state(ar);
     save_mixer_state(ar);

     XML_ParserFree(parser);
     fclose(file);
     return ar;

 err_parse:
     XML_ParserFree(parser);
 err_parser_create:
     fclose(file);
 err_fopen:
     free_mixer_state(ar);
 err_mixer_state:
     mixer_close(ar->mixer);
 err_mixer_open:
     free(ar);
     ar = NULL;
 err_calloc:
     return NULL;
 }

 void audio_route_free(struct audio_route *ar)
 {
     free_mixer_state(ar);
     mixer_close(ar->mixer);
     free(ar);
 }
	/*
	* Copyright (C) 2012 The Android Open Source Project
	* Inspired by TinyHW, written by Mark Brown at Wolfson Micro
	*
	* 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 "audio_hw_primary"
	/#define LOG_NDEBUG 0/

	#include <errno.h>
	#include <expat.h>
	#include <stdbool.h>
	#include <stdio.h>

	#include <cutils/log.h>
	#include <cutils/properties.h>

	#include <tinyalsa/asoundlib.h>

	#define BUF_SIZE 1024
	#define MIXER_XML_PATH "/system/etc/mixer_paths.xml"
	#define INITIAL_MIXER_PATH_SIZE 8

	#define MIXER_CARD 0

	struct mixer_state {
	struct mixer_ctl *ctl;
	unsigned int num_values;
	int *old_value;
	int *new_value;
	int *reset_value;
	/* If linked is true, only the first element in each array is valid */
	bool old_linked;
	bool new_linked;
	bool reset_linked;
	};

	struct mixer_setting {
	struct mixer_ctl *ctl;
	unsigned int num_values;
	int *value;
	/* If linked is true, only the first element in each array is valid */
	bool linked;
	};

	struct mixer_value {
	struct mixer_ctl *ctl;
	int index;
	int value;
	};

	struct mixer_path {
	char *name;
	unsigned int size;
	unsigned int length;
	struct mixer_setting *setting;
	};

	struct audio_route {
	struct mixer *mixer;
	unsigned int num_mixer_ctls;
	struct mixer_state *mixer_state;

	unsigned int mixer_path_size;
	unsigned int num_mixer_paths;
	struct mixer_path *mixer_path;
	};

	struct config_parse_state {
	struct audio_route *ar;
	struct mixer_path *path;
	int level;
	};

	/* path functions */

	static void path_print(struct mixer_path *path)
	{
	unsigned int i;
	unsigned int j;

	ALOGE("Path: %s, length: %d", path->name, path->length);
	for (i = 0; i < path->length; i++) {
	ALOGE(" id=%d: ctl=%s linked=%c", i,
	mixer_ctl_get_name(path->setting[i].ctl),
	path->setting[i].linked ? 'y' : 'n');
	for (j = 0; j < path->setting[i].num_values; j++)
	ALOGE(" id=%d value=%d", j, path->setting[i].value[j]);
	}
	}

	static void path_free(struct audio_route *ar)
	{
	unsigned int i;

	for (i = 0; i < ar->num_mixer_paths; i++) {
	if (ar->mixer_path[i].name)
	free(ar->mixer_path[i].name);
	if (ar->mixer_path[i].setting) {
	if (ar->mixer_path[i].setting->value)
	free(ar->mixer_path[i].setting->value);
	free(ar->mixer_path[i].setting);
	}
	}
	free(ar->mixer_path);
	}

	static struct mixer_path path_get_by_name(struct audio_route ar,
	const char *name)
	{
	unsigned int i;

	for (i = 0; i < ar->num_mixer_paths; i++)
	if (strcmp(ar->mixer_path[i].name, name) == 0)
	return &ar->mixer_path[i];

	return NULL;
	}

	static struct mixer_path path_create(struct audio_route ar, const char *name)
	{
	struct mixer_path *new_mixer_path = NULL;

	if (path_get_by_name(ar, name)) {
	ALOGE("Path name '%s' already exists", name);
	return NULL;
	}

	/* check if we need to allocate more space for mixer paths */
	if (ar->mixer_path_size <= ar->num_mixer_paths) {
	if (ar->mixer_path_size == 0)
	ar->mixer_path_size = INITIAL_MIXER_PATH_SIZE;
	else
	ar->mixer_path_size *= 2;

	new_mixer_path = realloc(ar->mixer_path, ar->mixer_path_size *
	sizeof(struct mixer_path));
	if (new_mixer_path == NULL) {
	ALOGE("Unable to allocate more paths");
	return NULL;
	} else {
	ar->mixer_path = new_mixer_path;
	}
	}

	/* initialise the new mixer path */
	ar->mixer_path[ar->num_mixer_paths].name = strdup(name);
	ar->mixer_path[ar->num_mixer_paths].size = 0;
	ar->mixer_path[ar->num_mixer_paths].length = 0;
	ar->mixer_path[ar->num_mixer_paths].setting = NULL;

	/* return the mixer path just added, then increment number of them */
	return &ar->mixer_path[ar->num_mixer_paths++];
	}

	static int find_ctl_in_path(struct mixer_path path, struct mixer_ctl ctl)
	{
	unsigned int i;

	for (i = 0; i < path->length; i++)
	if (path->setting[i].ctl == ctl)
	return i;

	return -1;
	}

	static int alloc_path_setting(struct mixer_path *path)
	{
	struct mixer_setting *new_path_setting;
	int path_index;

	/* check if we need to allocate more space for path settings */
	if (path->size <= path->length) {
	if (path->size == 0)
	path->size = INITIAL_MIXER_PATH_SIZE;
	else
	path->size *= 2;

	new_path_setting = realloc(path->setting,
	path->size * sizeof(struct mixer_setting));
	if (new_path_setting == NULL) {
	ALOGE("Unable to allocate more path settings");
	return -1;
	} else {
	path->setting = new_path_setting;
	}
	}

	path_index = path->length;
	path->length++;

	return path_index;
	}

	static int path_add_setting(struct mixer_path *path,
	struct mixer_setting *setting)
	{
	unsigned int i;
	int path_index;

	if (find_ctl_in_path(path, setting->ctl) != -1) {
	ALOGE("Control '%s' already exists in path '%s'",
	mixer_ctl_get_name(setting->ctl), path->name);
	return -1;
	}

	path_index = alloc_path_setting(path);
	if (path_index < 0)
	return -1;

	path->setting[path_index].ctl = setting->ctl;
	path->setting[path_index].num_values = setting->num_values;
	path->setting[path_index].value = malloc(setting->num_values * sizeof(int));
	path->setting[path_index].linked = setting->linked;
	if (setting->linked) {
	path->setting[path_index].value[0] = setting->value[0];
	} else {
	for (i = 0; i < setting->num_values; i++)
	path->setting[path_index].value[i] = setting->value[i];
	}

	return 0;
	}

	static int path_add_value(struct mixer_path *path,
	struct mixer_value *mixer_value)
	{
	unsigned int i;
	int path_index;
	unsigned int num_values;

	/* Check that mixer value index is within range */
	num_values = mixer_ctl_get_num_values(mixer_value->ctl);
	if (mixer_value->index >= (int)num_values) {
	ALOGE("mixer index %d is out of range for '%s'", mixer_value->index,
	mixer_ctl_get_name(mixer_value->ctl));
	return -1;
	}

	path_index = find_ctl_in_path(path, mixer_value->ctl);
	if (path_index < 0) {
	/* New path */

	path_index = alloc_path_setting(path);
	if (path_index < 0)
	return -1;

	/* initialise the new path setting */
	path->setting[path_index].ctl = mixer_value->ctl;
	path->setting[path_index].num_values = num_values;
	path->setting[path_index].value = malloc(num_values * sizeof(int));
	}

	if (mixer_value->index == -1) {
	/* Linked, so only set the first value */
	path->setting[path_index].linked = true;
	path->setting[path_index].value[0] = mixer_value->value;
	} else {
	if (path->setting[path_index].linked && (num_values > 1)) {
	/* Unlinking the values, so duplicate them across */
	for (i = 1; i < num_values; i++) {
	path->setting[path_index].value[i] =
	path->setting[path_index].value[0];
	}
	path->setting[path_index].linked = false;
	}
	path->setting[path_index].value[mixer_value->index] = mixer_value->value;
	}

	return 0;
	}

	static int path_add_path(struct mixer_path path, struct mixer_path sub_path)
	{
	unsigned int i;

	for (i = 0; i < sub_path->length; i++)
	if (path_add_setting(path, &sub_path->setting[i]) < 0)
	return -1;

	return 0;
	}

	static int path_apply(struct audio_route ar, struct mixer_path path)
	{
	unsigned int i;
	unsigned int j;
	unsigned int ctl_index;

	for (i = 0; i < path->length; i++) {
	struct mixer_ctl *ctl = path->setting[i].ctl;

	/* locate the mixer ctl in the list */
	for (ctl_index = 0; ctl_index < ar->num_mixer_ctls; ctl_index++)
	if (ar->mixer_state[ctl_index].ctl == ctl)
	break;

	/* apply the new value(s) */
	for (j = 0; j < ar->mixer_state[ctl_index].num_values; j++) {
	ar->mixer_state[ctl_index].new_value[j] = path->setting[i].value[j];
	if (path->setting[i].linked)
	break;
	}
	ar->mixer_state[ctl_index].new_linked = path->setting[i].linked;
	}

	return 0;
	}

	/* mixer helper function */
	static int mixer_enum_string_to_value(struct mixer_ctl ctl, const char string)
	{
	unsigned int i;

	/* Search the enum strings for a particular one */
	for (i = 0; i < mixer_ctl_get_num_enums(ctl); i++) {
	if (strcmp(mixer_ctl_get_enum_string(ctl, i), string) == 0)
	break;
	}

	return i;
	}

	static void start_tag(void data, const XML_Char tag_name,
	const XML_Char **attr)
	{
	const XML_Char *attr_name = NULL;
	const XML_Char *attr_id = NULL;
	const XML_Char *attr_value = NULL;
	struct config_parse_state *state = data;
	struct audio_route *ar = state->ar;
	unsigned int i;
	unsigned int ctl_index;
	struct mixer_ctl *ctl;
	int value;
	unsigned int id;
	struct mixer_value mixer_value;

	/* Get name, id and value attributes (these may be empty) */
	for (i = 0; attr[i]; i += 2) {
	if (strcmp(attr[i], "name") == 0)
	attr_name = attr[i + 1];
	if (strcmp(attr[i], "id") == 0)
	attr_id = attr[i + 1];
	else if (strcmp(attr[i], "value") == 0)
	attr_value = attr[i + 1];
	}

	/* Look at tags */
	if (strcmp(tag_name, "path") == 0) {
	if (attr_name == NULL) {
	ALOGE("Unnamed path!");
	} else {
	if (state->level == 1) {
	/* top level path: create and stash the path */
	state->path = path_create(ar, (char *)attr_name);
	} else {
	/* nested path */
	struct mixer_path *sub_path = path_get_by_name(ar, attr_name);
	path_add_path(state->path, sub_path);
	}
	}
	}

	else if (strcmp(tag_name, "ctl") == 0) {
	/* Obtain the mixer ctl and value */
	ctl = mixer_get_ctl_by_name(ar->mixer, attr_name);
	switch (mixer_ctl_get_type(ctl)) {
	case MIXER_CTL_TYPE_BOOL:
	case MIXER_CTL_TYPE_INT:
	value = atoi((char *)attr_value);
	break;
	case MIXER_CTL_TYPE_ENUM:
	value = mixer_enum_string_to_value(ctl, (char *)attr_value);
	break;
	default:
	value = 0;
	break;
	}

	if (state->level == 1) {
	/* top level ctl (initial setting) */

	/* locate the mixer ctl in the list */
	for (ctl_index = 0; ctl_index < ar->num_mixer_ctls; ctl_index++) {
	if (ar->mixer_state[ctl_index].ctl == ctl)
	break;
	}

	/* apply the new value */
	if (attr_id) {
	/* set only one value */
	id = atoi((char *)attr_id);
	if (id < ar->mixer_state[ctl_index].num_values) {
	/*
	* We're unlinking the values, so copy old_value[0] into
	* all the new_value elements.
	*/
	for (i = 0; i < ar->mixer_state[ctl_index].num_values; i++) {
	ar->mixer_state[ctl_index].new_value[i] =
	ar->mixer_state[ctl_index].old_value[0];
	}
	ar->mixer_state[ctl_index].new_linked = false;
	ar->mixer_state[ctl_index].new_value[id] = value;
	} else {
	ALOGE("value id out of range for mixer ctl '%s'",
	mixer_ctl_get_name(ctl));
	}
	} else {
	ar->mixer_state[ctl_index].new_value[0] = value;
	ar->mixer_state[ctl_index].new_linked = true;
	}
	} else {
	/* nested ctl (within a path) */
	mixer_value.ctl = ctl;
	mixer_value.value = value;
	if (attr_id)
	mixer_value.index = atoi((char *)attr_id);
	else
	mixer_value.index = -1;
	path_add_value(state->path, &mixer_value);
	}
	}

	state->level++;
	}

	static void end_tag(void data, const XML_Char tag_name)
	{
	struct config_parse_state *state = data;

	state->level--;
	}

	static int alloc_mixer_state(struct audio_route *ar)
	{
	unsigned int i;
	unsigned int j;
	unsigned int num_values;
	struct mixer_ctl *ctl;
	bool linked;

	ar->num_mixer_ctls = mixer_get_num_ctls(ar->mixer);
	ar->mixer_state = malloc(ar->num_mixer_ctls * sizeof(struct mixer_state));
	if (!ar->mixer_state)
	return -1;

	for (i = 0; i < ar->num_mixer_ctls; i++) {
	ctl = mixer_get_ctl(ar->mixer, i);
	num_values = mixer_ctl_get_num_values(ctl);

	ar->mixer_state[i].old_value = malloc(num_values * sizeof(int));
	ar->mixer_state[i].new_value = malloc(num_values * sizeof(int));
	ar->mixer_state[i].reset_value = malloc(num_values * sizeof(int));

	/*
	* Get all mixer values for controls with multiple values. If all
	* values are the same, set the linked flag.
	*/
	linked = true;
	for (j = 0; j < num_values; j++) {
	ar->mixer_state[i].old_value[j] = mixer_ctl_get_value(ctl, j);
	ar->mixer_state[i].new_value[j] = ar->mixer_state[i].old_value[j];

	/*
	* If the next value is different from the last, set linked to
	* false.
	*/
	if ((j > 0) && (ar->mixer_state[i].old_value[j - 1] !=
	ar->mixer_state[i].old_value[j])) {
	linked = false;
	}
	}
	ar->mixer_state[i].ctl = ctl;
	ar->mixer_state[i].old_linked = linked;
	ar->mixer_state[i].new_linked = linked;
	ar->mixer_state[i].num_values = num_values;
	}

	return 0;
	}

	static void free_mixer_state(struct audio_route *ar)
	{
	unsigned int i;

	for (i = 0; i < ar->num_mixer_ctls; i++) {
	free(ar->mixer_state[i].old_value);
	free(ar->mixer_state[i].new_value);
	free(ar->mixer_state[i].reset_value);
	}

	free(ar->mixer_state);
	ar->mixer_state = NULL;
	}

	void update_mixer_state(struct audio_route *ar)
	{
	unsigned int i;
	unsigned int j;

	for (i = 0; i < ar->num_mixer_ctls; i++) {
	unsigned int num_values = ar->mixer_state[i].num_values;

	/* if the value has changed, update the mixer */
	if (ar->mixer_state[i].new_linked) {
	if (ar->mixer_state[i].old_value[0] != ar->mixer_state[i].new_value[0]) {
	/* linked ctl, so set all ctl values the same */
	for (j = 0; j < num_values; j++)
	mixer_ctl_set_value(ar->mixer_state[i].ctl, j,
	ar->mixer_state[i].new_value[0]);
	ar->mixer_state[i].old_value[0] = ar->mixer_state[i].new_value[0];
	}
	} else {
	for (j = 0; j < num_values; j++) {
	/* unlinked ctl, so set each value if necessary */
	if (ar->mixer_state[i].old_value[j] != ar->mixer_state[i].new_value[j]) {
	mixer_ctl_set_value(ar->mixer_state[i].ctl, j,
	ar->mixer_state[i].new_value[j]);
	ar->mixer_state[i].old_value[j] = ar->mixer_state[i].new_value[j];
	}
	}
	}
	ar->mixer_state[i].old_linked = ar->mixer_state[i].new_linked;
	}
	}

	/* saves the current state of the mixer, for resetting all controls */
	static void save_mixer_state(struct audio_route *ar)
	{
	unsigned int i;
	unsigned int j;

	for (i = 0; i < ar->num_mixer_ctls; i++) {
	for (j = 0; j < ar->mixer_state[i].num_values; j++) {
	ar->mixer_state[i].reset_value[j] = ar->mixer_state[i].new_value[j];

	/* if the values are linked, only need to save value 0 */
	if (ar->mixer_state[i].new_linked)
	break;
	}
	ar->mixer_state[i].reset_linked = ar->mixer_state[i].new_linked;
	}
	}

	/* this resets all mixer settings to the saved values */
	void reset_mixer_state(struct audio_route *ar)
	{
	unsigned int i;
	unsigned int j;

	/* load all of the saved values */
	for (i = 0; i < ar->num_mixer_ctls; i++) {
	for (j = 0; j < ar->mixer_state[i].num_values; j++) {
	ar->mixer_state[i].new_value[j] = ar->mixer_state[i].reset_value[j];

	/* if the values are linked, only need to save value 0 */
	if (ar->mixer_state[i].reset_linked)
	break;
	}
	ar->mixer_state[i].new_linked = ar->mixer_state[i].reset_linked;
	}
	}

	void audio_route_apply_path(struct audio_route ar, const char name)
	{
	struct mixer_path *path;

	if (!ar) {
	ALOGE("invalid audio_route");
	return;
	}

	path = path_get_by_name(ar, name);
	if (!path) {
	ALOGE("unable to find path '%s'", name);
	return;
	}

	path_apply(ar, path);
	}

	struct audio_route *audio_route_init(void)
	{
	struct config_parse_state state;
	XML_Parser parser;
	FILE *file;
	int bytes_read;
	void *buf;
	int i;
	struct mixer_path *path;
	struct audio_route *ar;
	/* TODO remove when lunchbox is deprecated */
	char property[PROPERTY_VALUE_MAX];
	int hw_revision;

	property_get("ro.revision", property, "1");
	hw_revision = atoi(property);

	ar = calloc(1, sizeof(struct audio_route));
	if (!ar)
	goto err_calloc;

	ar->mixer = mixer_open(MIXER_CARD);
	if (!ar->mixer) {
	ALOGE("Unable to open the mixer, aborting.");
	goto err_mixer_open;
	}

	ar->mixer_path = NULL;
	ar->mixer_path_size = 0;
	ar->num_mixer_paths = 0;

	/* allocate space for and read current mixer settings */
	if (alloc_mixer_state(ar) < 0)
	goto err_mixer_state;

	/* TODO remove when lunchbox is deprecated */
	if (hw_revision == 1)
	file = fopen("/system/etc/mixer_paths_lb.xml", "r");
	else
	file = fopen(MIXER_XML_PATH, "r");

	if (!file) {
	ALOGE("Failed to open %s", MIXER_XML_PATH);
	goto err_fopen;
	}

	parser = XML_ParserCreate(NULL);
	if (!parser) {
	ALOGE("Failed to create XML parser");
	goto err_parser_create;
	}

	memset(&state, 0, sizeof(state));
	state.ar = ar;
	XML_SetUserData(parser, &state);
	XML_SetElementHandler(parser, start_tag, end_tag);

	for (;;) {
	buf = XML_GetBuffer(parser, BUF_SIZE);
	if (buf == NULL)
	goto err_parse;

	bytes_read = fread(buf, 1, BUF_SIZE, file);
	if (bytes_read < 0)
	goto err_parse;

	if (XML_ParseBuffer(parser, bytes_read,
	bytes_read == 0) == XML_STATUS_ERROR) {
	ALOGE("Error in mixer xml (%s)", MIXER_XML_PATH);
	goto err_parse;
	}

	if (bytes_read == 0)
	break;
	}

	/* apply the initial mixer values, and save them so we can reset the
	mixer to the original values */
	update_mixer_state(ar);
	save_mixer_state(ar);

	XML_ParserFree(parser);
	fclose(file);
	return ar;

	err_parse:
	XML_ParserFree(parser);
	err_parser_create:
	fclose(file);
	err_fopen:
	free_mixer_state(ar);
	err_mixer_state:
	mixer_close(ar->mixer);
	err_mixer_open:
	free(ar);
	ar = NULL;
	err_calloc:
	return NULL;
	}

	void audio_route_free(struct audio_route *ar)
	{
	free_mixer_state(ar);
	mixer_close(ar->mixer);
	free(ar);
	}