/* * dbll.c * * DSP-BIOS Bridge driver support functions for TI OMAP processors. * * Copyright (C) 2005-2006 Texas Instruments, Inc. * * This package is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * THIS PACKAGE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE. */ #include <linux/types.h> /* ----------------------------------- Host OS */ #include <dspbridge/host_os.h> /* ----------------------------------- DSP/BIOS Bridge */ #include <dspbridge/dbdefs.h> /* ----------------------------------- Trace & Debug */ #include <dspbridge/dbc.h> #include <dspbridge/gh.h> /* ----------------------------------- OS Adaptation Layer */ /* Dynamic loader library interface */ #include <dspbridge/dynamic_loader.h> #include <dspbridge/getsection.h> /* ----------------------------------- This */ #include <dspbridge/dbll.h> #include <dspbridge/rmm.h> /* Number of buckets for symbol hash table */ #define MAXBUCKETS 211 /* Max buffer length */ #define MAXEXPR 128 #define DOFF_ALIGN(x) (((x) + 3) & ~3UL) /* * ======== struct dbll_tar_obj* ======== * A target may have one or more libraries of symbols/code/data loaded * onto it, where a library is simply the symbols/code/data contained * in a DOFF file. */ /* * ======== dbll_tar_obj ======== */ struct dbll_tar_obj { struct dbll_attrs attrs; struct dbll_library_obj *head; /* List of all opened libraries */ }; /* * The following 4 typedefs are "super classes" of the dynamic loader * library types used in dynamic loader functions (dynamic_loader.h). */ /* * ======== dbll_stream ======== * Contains dynamic_loader_stream */ struct dbll_stream { struct dynamic_loader_stream dl_stream; struct dbll_library_obj *lib; }; /* * ======== ldr_symbol ======== */ struct ldr_symbol { struct dynamic_loader_sym dl_symbol; struct dbll_library_obj *lib; }; /* * ======== dbll_alloc ======== */ struct dbll_alloc { struct dynamic_loader_allocate dl_alloc; struct dbll_library_obj *lib; }; /* * ======== dbll_init_obj ======== */ struct dbll_init_obj { struct dynamic_loader_initialize dl_init; struct dbll_library_obj *lib; }; /* * ======== DBLL_Library ======== * A library handle is returned by DBLL_Open() and is passed to dbll_load() * to load symbols/code/data, and to dbll_unload(), to remove the * symbols/code/data loaded by dbll_load(). */ /* * ======== dbll_library_obj ======== */ struct dbll_library_obj { struct dbll_library_obj *next; /* Next library in target's list */ struct dbll_library_obj *prev; /* Previous in the list */ struct dbll_tar_obj *target_obj; /* target for this library */ /* Objects needed by dynamic loader */ struct dbll_stream stream; struct ldr_symbol symbol; struct dbll_alloc allocate; struct dbll_init_obj init; void *dload_mod_obj; char *file_name; /* COFF file name */ void *fp; /* Opaque file handle */ u32 entry; /* Entry point */ void *desc; /* desc of DOFF file loaded */ u32 open_ref; /* Number of times opened */ u32 load_ref; /* Number of times loaded */ struct gh_t_hash_tab *sym_tab; /* Hash table of symbols */ u32 pos; }; /* * ======== dbll_symbol ======== */ struct dbll_symbol { struct dbll_sym_val value; char *name; }; static void dof_close(struct dbll_library_obj *zl_lib); static int dof_open(struct dbll_library_obj *zl_lib); static s32 no_op(struct dynamic_loader_initialize *thisptr, void *bufr, ldr_addr locn, struct ldr_section_info *info, unsigned bytsize); /* * Functions called by dynamic loader * */ /* dynamic_loader_stream */ static int dbll_read_buffer(struct dynamic_loader_stream *this, void *buffer, unsigned bufsize); static int dbll_set_file_posn(struct dynamic_loader_stream *this, unsigned int pos); /* dynamic_loader_sym */ static struct dynload_symbol *dbll_find_symbol(struct dynamic_loader_sym *this, const char *name); static struct dynload_symbol *dbll_add_to_symbol_table(struct dynamic_loader_sym *this, const char *name, unsigned module_id); static struct dynload_symbol *find_in_symbol_table(struct dynamic_loader_sym *this, const char *name, unsigned moduleid); static void dbll_purge_symbol_table(struct dynamic_loader_sym *this, unsigned module_id); static void *allocate(struct dynamic_loader_sym *this, unsigned memsize); static void deallocate(struct dynamic_loader_sym *this, void *mem_ptr); static void dbll_err_report(struct dynamic_loader_sym *this, const char *errstr, va_list args); /* dynamic_loader_allocate */ static int dbll_rmm_alloc(struct dynamic_loader_allocate *this, struct ldr_section_info *info, unsigned align); static void rmm_dealloc(struct dynamic_loader_allocate *this, struct ldr_section_info *info); /* dynamic_loader_initialize */ static int connect(struct dynamic_loader_initialize *this); static int read_mem(struct dynamic_loader_initialize *this, void *buf, ldr_addr addr, struct ldr_section_info *info, unsigned bytes); static int write_mem(struct dynamic_loader_initialize *this, void *buf, ldr_addr addr, struct ldr_section_info *info, unsigned nbytes); static int fill_mem(struct dynamic_loader_initialize *this, ldr_addr addr, struct ldr_section_info *info, unsigned bytes, unsigned val); static int execute(struct dynamic_loader_initialize *this, ldr_addr start); static void release(struct dynamic_loader_initialize *this); /* symbol table hash functions */ static u16 name_hash(void *key, u16 max_bucket); static bool name_match(void *key, void *sp); static void sym_delete(void *value); static u32 refs; /* module reference count */ /* Symbol Redefinition */ static int redefined_symbol; static int gbl_search = 1; /* * ======== dbll_close ======== */ void dbll_close(struct dbll_library_obj *zl_lib) { struct dbll_tar_obj *zl_target; DBC_REQUIRE(refs > 0); DBC_REQUIRE(zl_lib); DBC_REQUIRE(zl_lib->open_ref > 0); zl_target = zl_lib->target_obj; zl_lib->open_ref--; if (zl_lib->open_ref == 0) { /* Remove library from list */ if (zl_target->head == zl_lib) zl_target->head = zl_lib->next; if (zl_lib->prev) (zl_lib->prev)->next = zl_lib->next; if (zl_lib->next) (zl_lib->next)->prev = zl_lib->prev; /* Free DOF resources */ dof_close(zl_lib); kfree(zl_lib->file_name); /* remove symbols from symbol table */ if (zl_lib->sym_tab) gh_delete(zl_lib->sym_tab); /* remove the library object itself */ kfree(zl_lib); zl_lib = NULL; } } /* * ======== dbll_create ======== */ int dbll_create(struct dbll_tar_obj **target_obj, struct dbll_attrs *pattrs) { struct dbll_tar_obj *pzl_target; int status = 0; DBC_REQUIRE(refs > 0); DBC_REQUIRE(pattrs != NULL); DBC_REQUIRE(target_obj != NULL); /* Allocate DBL target object */ pzl_target = kzalloc(sizeof(struct dbll_tar_obj), GFP_KERNEL); if (target_obj != NULL) { if (pzl_target == NULL) { *target_obj = NULL; status = -ENOMEM; } else { pzl_target->attrs = *pattrs; *target_obj = (struct dbll_tar_obj *)pzl_target; } DBC_ENSURE((!status && *target_obj) || (status && *target_obj == NULL)); } return status; } /* * ======== dbll_delete ======== */ void dbll_delete(struct dbll_tar_obj *target) { struct dbll_tar_obj *zl_target = (struct dbll_tar_obj *)target; DBC_REQUIRE(refs > 0); DBC_REQUIRE(zl_target); kfree(zl_target); } /* * ======== dbll_exit ======== * Discontinue usage of DBL module. */ void dbll_exit(void) { DBC_REQUIRE(refs > 0); refs--; if (refs == 0) gh_exit(); DBC_ENSURE(refs >= 0); } /* * ======== dbll_get_addr ======== * Get address of name in the specified library. */ bool dbll_get_addr(struct dbll_library_obj *zl_lib, char *name, struct dbll_sym_val **sym_val) { struct dbll_symbol *sym; bool status = false; DBC_REQUIRE(refs > 0); DBC_REQUIRE(zl_lib); DBC_REQUIRE(name != NULL); DBC_REQUIRE(sym_val != NULL); DBC_REQUIRE(zl_lib->sym_tab != NULL); sym = (struct dbll_symbol *)gh_find(zl_lib->sym_tab, name); if (sym != NULL) { *sym_val = &sym->value; status = true; } dev_dbg(bridge, "%s: lib: %p name: %s paddr: %p, status 0x%x\n", __func__, zl_lib, name, sym_val, status); return status; } /* * ======== dbll_get_attrs ======== * Retrieve the attributes of the target. */ void dbll_get_attrs(struct dbll_tar_obj *target, struct dbll_attrs *pattrs) { struct dbll_tar_obj *zl_target = (struct dbll_tar_obj *)target; DBC_REQUIRE(refs > 0); DBC_REQUIRE(zl_target); DBC_REQUIRE(pattrs != NULL); if ((pattrs != NULL) && (zl_target != NULL)) *pattrs = zl_target->attrs; } /* * ======== dbll_get_c_addr ======== * Get address of a "C" name in the specified library. */ bool dbll_get_c_addr(struct dbll_library_obj *zl_lib, char *name, struct dbll_sym_val **sym_val) { struct dbll_symbol *sym; char cname[MAXEXPR + 1]; bool status = false; DBC_REQUIRE(refs > 0); DBC_REQUIRE(zl_lib); DBC_REQUIRE(sym_val != NULL); DBC_REQUIRE(zl_lib->sym_tab != NULL); DBC_REQUIRE(name != NULL); cname[0] = '_'; strncpy(cname + 1, name, sizeof(cname) - 2); cname[MAXEXPR] = '\0'; /* insure '\0' string termination */ /* Check for C name, if not found */ sym = (struct dbll_symbol *)gh_find(zl_lib->sym_tab, cname); if (sym != NULL) { *sym_val = &sym->value; status = true; } return status; } /* * ======== dbll_get_sect ======== * Get the base address and size (in bytes) of a COFF section. */ int dbll_get_sect(struct dbll_library_obj *lib, char *name, u32 *paddr, u32 *psize) { u32 byte_size; bool opened_doff = false; const struct ldr_section_info *sect = NULL; struct dbll_library_obj *zl_lib = (struct dbll_library_obj *)lib; int status = 0; DBC_REQUIRE(refs > 0); DBC_REQUIRE(name != NULL); DBC_REQUIRE(paddr != NULL); DBC_REQUIRE(psize != NULL); DBC_REQUIRE(zl_lib); /* If DOFF file is not open, we open it. */ if (zl_lib != NULL) { if (zl_lib->fp == NULL) { status = dof_open(zl_lib); if (!status) opened_doff = true; } else { (*(zl_lib->target_obj->attrs.fseek)) (zl_lib->fp, zl_lib->pos, SEEK_SET); } } else { status = -EFAULT; } if (!status) { byte_size = 1; if (dload_get_section_info(zl_lib->desc, name, §)) { *paddr = sect->load_addr; *psize = sect->size * byte_size; /* Make sure size is even for good swap */ if (*psize % 2) (*psize)++; /* Align size */ *psize = DOFF_ALIGN(*psize); } else { status = -ENXIO; } } if (opened_doff) { dof_close(zl_lib); opened_doff = false; } dev_dbg(bridge, "%s: lib: %p name: %s paddr: %p psize: %p, " "status 0x%x\n", __func__, lib, name, paddr, psize, status); return status; } /* * ======== dbll_init ======== */ bool dbll_init(void) { DBC_REQUIRE(refs >= 0); if (refs == 0) gh_init(); refs++; return true; } /* * ======== dbll_load ======== */ int dbll_load(struct dbll_library_obj *lib, dbll_flags flags, struct dbll_attrs *attrs, u32 *entry) { struct dbll_library_obj *zl_lib = (struct dbll_library_obj *)lib; struct dbll_tar_obj *dbzl; bool got_symbols = true; s32 err; int status = 0; bool opened_doff = false; DBC_REQUIRE(refs > 0); DBC_REQUIRE(zl_lib); DBC_REQUIRE(entry != NULL); DBC_REQUIRE(attrs != NULL); /* * Load if not already loaded. */ if (zl_lib->load_ref == 0 || !(flags & DBLL_DYNAMIC)) { dbzl = zl_lib->target_obj; dbzl->attrs = *attrs; /* Create a hash table for symbols if not already created */ if (zl_lib->sym_tab == NULL) { got_symbols = false; zl_lib->sym_tab = gh_create(MAXBUCKETS, sizeof(struct dbll_symbol), name_hash, name_match, sym_delete); if (zl_lib->sym_tab == NULL) status = -ENOMEM; } /* * Set up objects needed by the dynamic loader */ /* Stream */ zl_lib->stream.dl_stream.read_buffer = dbll_read_buffer; zl_lib->stream.dl_stream.set_file_posn = dbll_set_file_posn; zl_lib->stream.lib = zl_lib; /* Symbol */ zl_lib->symbol.dl_symbol.find_matching_symbol = dbll_find_symbol; if (got_symbols) { zl_lib->symbol.dl_symbol.add_to_symbol_table = find_in_symbol_table; } else { zl_lib->symbol.dl_symbol.add_to_symbol_table = dbll_add_to_symbol_table; } zl_lib->symbol.dl_symbol.purge_symbol_table = dbll_purge_symbol_table; zl_lib->symbol.dl_symbol.dload_allocate = allocate; zl_lib->symbol.dl_symbol.dload_deallocate = deallocate; zl_lib->symbol.dl_symbol.error_report = dbll_err_report; zl_lib->symbol.lib = zl_lib; /* Allocate */ zl_lib->allocate.dl_alloc.dload_allocate = dbll_rmm_alloc; zl_lib->allocate.dl_alloc.dload_deallocate = rmm_dealloc; zl_lib->allocate.lib = zl_lib; /* Init */ zl_lib->init.dl_init.connect = connect; zl_lib->init.dl_init.readmem = read_mem; zl_lib->init.dl_init.writemem = write_mem; zl_lib->init.dl_init.fillmem = fill_mem; zl_lib->init.dl_init.execute = execute; zl_lib->init.dl_init.release = release; zl_lib->init.lib = zl_lib; /* If COFF file is not open, we open it. */ if (zl_lib->fp == NULL) { status = dof_open(zl_lib); if (!status) opened_doff = true; } if (!status) { zl_lib->pos = (*(zl_lib->target_obj->attrs.ftell)) (zl_lib->fp); /* Reset file cursor */ (*(zl_lib->target_obj->attrs.fseek)) (zl_lib->fp, (long)0, SEEK_SET); symbols_reloaded = true; /* The 5th argument, DLOAD_INITBSS, tells the DLL * module to zero-init all BSS sections. In general, * this is not necessary and also increases load time. * We may want to make this configurable by the user */ err = dynamic_load_module(&zl_lib->stream.dl_stream, &zl_lib->symbol.dl_symbol, &zl_lib->allocate.dl_alloc, &zl_lib->init.dl_init, DLOAD_INITBSS, &zl_lib->dload_mod_obj); if (err != 0) { status = -EILSEQ; } else if (redefined_symbol) { zl_lib->load_ref++; dbll_unload(zl_lib, (struct dbll_attrs *)attrs); redefined_symbol = false; status = -EILSEQ; } else { *entry = zl_lib->entry; } } } if (!status) zl_lib->load_ref++; /* Clean up DOFF resources */ if (opened_doff) dof_close(zl_lib); DBC_ENSURE(status || zl_lib->load_ref > 0); dev_dbg(bridge, "%s: lib: %p flags: 0x%x entry: %p, status 0x%x\n", __func__, lib, flags, entry, status); return status; } /* * ======== dbll_open ======== */ int dbll_open(struct dbll_tar_obj *target, char *file, dbll_flags flags, struct dbll_library_obj **lib_obj) { struct dbll_tar_obj *zl_target = (struct dbll_tar_obj *)target; struct dbll_library_obj *zl_lib = NULL; s32 err; int status = 0; DBC_REQUIRE(refs > 0); DBC_REQUIRE(zl_target); DBC_REQUIRE(zl_target->attrs.fopen != NULL); DBC_REQUIRE(file != NULL); DBC_REQUIRE(lib_obj != NULL); zl_lib = zl_target->head; while (zl_lib != NULL) { if (strcmp(zl_lib->file_name, file) == 0) { /* Library is already opened */ zl_lib->open_ref++; break; } zl_lib = zl_lib->next; } if (zl_lib == NULL) { /* Allocate DBL library object */ zl_lib = kzalloc(sizeof(struct dbll_library_obj), GFP_KERNEL); if (zl_lib == NULL) { status = -ENOMEM; } else { zl_lib->pos = 0; /* Increment ref count to allow close on failure * later on */ zl_lib->open_ref++; zl_lib->target_obj = zl_target; /* Keep a copy of the file name */ zl_lib->file_name = kzalloc(strlen(file) + 1, GFP_KERNEL); if (zl_lib->file_name == NULL) { status = -ENOMEM; } else { strncpy(zl_lib->file_name, file, strlen(file) + 1); } zl_lib->sym_tab = NULL; } } /* * Set up objects needed by the dynamic loader */ if (status) goto func_cont; /* Stream */ zl_lib->stream.dl_stream.read_buffer = dbll_read_buffer; zl_lib->stream.dl_stream.set_file_posn = dbll_set_file_posn; zl_lib->stream.lib = zl_lib; /* Symbol */ zl_lib->symbol.dl_symbol.add_to_symbol_table = dbll_add_to_symbol_table; zl_lib->symbol.dl_symbol.find_matching_symbol = dbll_find_symbol; zl_lib->symbol.dl_symbol.purge_symbol_table = dbll_purge_symbol_table; zl_lib->symbol.dl_symbol.dload_allocate = allocate; zl_lib->symbol.dl_symbol.dload_deallocate = deallocate; zl_lib->symbol.dl_symbol.error_report = dbll_err_report; zl_lib->symbol.lib = zl_lib; /* Allocate */ zl_lib->allocate.dl_alloc.dload_allocate = dbll_rmm_alloc; zl_lib->allocate.dl_alloc.dload_deallocate = rmm_dealloc; zl_lib->allocate.lib = zl_lib; /* Init */ zl_lib->init.dl_init.connect = connect; zl_lib->init.dl_init.readmem = read_mem; zl_lib->init.dl_init.writemem = write_mem; zl_lib->init.dl_init.fillmem = fill_mem; zl_lib->init.dl_init.execute = execute; zl_lib->init.dl_init.release = release; zl_lib->init.lib = zl_lib; if (!status && zl_lib->fp == NULL) status = dof_open(zl_lib); zl_lib->pos = (*(zl_lib->target_obj->attrs.ftell)) (zl_lib->fp); (*(zl_lib->target_obj->attrs.fseek)) (zl_lib->fp, (long)0, SEEK_SET); /* Create a hash table for symbols if flag is set */ if (zl_lib->sym_tab != NULL || !(flags & DBLL_SYMB)) goto func_cont; zl_lib->sym_tab = gh_create(MAXBUCKETS, sizeof(struct dbll_symbol), name_hash, name_match, sym_delete); if (zl_lib->sym_tab == NULL) { status = -ENOMEM; } else { /* Do a fake load to get symbols - set write func to no_op */ zl_lib->init.dl_init.writemem = no_op; err = dynamic_open_module(&zl_lib->stream.dl_stream, &zl_lib->symbol.dl_symbol, &zl_lib->allocate.dl_alloc, &zl_lib->init.dl_init, 0, &zl_lib->dload_mod_obj); if (err != 0) { status = -EILSEQ; } else { /* Now that we have the symbol table, we can unload */ err = dynamic_unload_module(zl_lib->dload_mod_obj, &zl_lib->symbol.dl_symbol, &zl_lib->allocate.dl_alloc, &zl_lib->init.dl_init); if (err != 0) status = -EILSEQ; zl_lib->dload_mod_obj = NULL; } } func_cont: if (!status) { if (zl_lib->open_ref == 1) { /* First time opened - insert in list */ if (zl_target->head) (zl_target->head)->prev = zl_lib; zl_lib->prev = NULL; zl_lib->next = zl_target->head; zl_target->head = zl_lib; } *lib_obj = (struct dbll_library_obj *)zl_lib; } else { *lib_obj = NULL; if (zl_lib != NULL) dbll_close((struct dbll_library_obj *)zl_lib); } DBC_ENSURE((!status && (zl_lib->open_ref > 0) && *lib_obj) || (status && *lib_obj == NULL)); dev_dbg(bridge, "%s: target: %p file: %s lib_obj: %p, status 0x%x\n", __func__, target, file, lib_obj, status); return status; } /* * ======== dbll_read_sect ======== * Get the content of a COFF section. */ int dbll_read_sect(struct dbll_library_obj *lib, char *name, char *buf, u32 size) { struct dbll_library_obj *zl_lib = (struct dbll_library_obj *)lib; bool opened_doff = false; u32 byte_size; /* size of bytes */ u32 ul_sect_size; /* size of section */ const struct ldr_section_info *sect = NULL; int status = 0; DBC_REQUIRE(refs > 0); DBC_REQUIRE(zl_lib); DBC_REQUIRE(name != NULL); DBC_REQUIRE(buf != NULL); DBC_REQUIRE(size != 0); /* If DOFF file is not open, we open it. */ if (zl_lib != NULL) { if (zl_lib->fp == NULL) { status = dof_open(zl_lib); if (!status) opened_doff = true; } else { (*(zl_lib->target_obj->attrs.fseek)) (zl_lib->fp, zl_lib->pos, SEEK_SET); } } else { status = -EFAULT; } if (status) goto func_cont; byte_size = 1; if (!dload_get_section_info(zl_lib->desc, name, §)) { status = -ENXIO; goto func_cont; } /* * Ensure the supplied buffer size is sufficient to store * the section buf to be read. */ ul_sect_size = sect->size * byte_size; /* Make sure size is even for good swap */ if (ul_sect_size % 2) ul_sect_size++; /* Align size */ ul_sect_size = DOFF_ALIGN(ul_sect_size); if (ul_sect_size > size) { status = -EPERM; } else { if (!dload_get_section(zl_lib->desc, sect, buf)) status = -EBADF; } func_cont: if (opened_doff) { dof_close(zl_lib); opened_doff = false; } dev_dbg(bridge, "%s: lib: %p name: %s buf: %p size: 0x%x, " "status 0x%x\n", __func__, lib, name, buf, size, status); return status; } /* * ======== dbll_unload ======== */ void dbll_unload(struct dbll_library_obj *lib, struct dbll_attrs *attrs) { struct dbll_library_obj *zl_lib = (struct dbll_library_obj *)lib; s32 err = 0; DBC_REQUIRE(refs > 0); DBC_REQUIRE(zl_lib); DBC_REQUIRE(zl_lib->load_ref > 0); dev_dbg(bridge, "%s: lib: %p\n", __func__, lib); zl_lib->load_ref--; /* Unload only if reference count is 0 */ if (zl_lib->load_ref != 0) goto func_end; zl_lib->target_obj->attrs = *attrs; if (zl_lib->dload_mod_obj) { err = dynamic_unload_module(zl_lib->dload_mod_obj, &zl_lib->symbol.dl_symbol, &zl_lib->allocate.dl_alloc, &zl_lib->init.dl_init); if (err != 0) dev_dbg(bridge, "%s: failed: 0x%x\n", __func__, err); } /* remove symbols from symbol table */ if (zl_lib->sym_tab != NULL) { gh_delete(zl_lib->sym_tab); zl_lib->sym_tab = NULL; } /* delete DOFF desc since it holds *lots* of host OS * resources */ dof_close(zl_lib); func_end: DBC_ENSURE(zl_lib->load_ref >= 0); } /* * ======== dof_close ======== */ static void dof_close(struct dbll_library_obj *zl_lib) { if (zl_lib->desc) { dload_module_close(zl_lib->desc); zl_lib->desc = NULL; } /* close file */ if (zl_lib->fp) { (zl_lib->target_obj->attrs.fclose) (zl_lib->fp); zl_lib->fp = NULL; } } /* * ======== dof_open ======== */ static int dof_open(struct dbll_library_obj *zl_lib) { void *open = *(zl_lib->target_obj->attrs.fopen); int status = 0; /* First open the file for the dynamic loader, then open COF */ zl_lib->fp = (void *)((dbll_f_open_fxn) (open)) (zl_lib->file_name, "rb"); /* Open DOFF module */ if (zl_lib->fp && zl_lib->desc == NULL) { (*(zl_lib->target_obj->attrs.fseek)) (zl_lib->fp, (long)0, SEEK_SET); zl_lib->desc = dload_module_open(&zl_lib->stream.dl_stream, &zl_lib->symbol.dl_symbol); if (zl_lib->desc == NULL) { (zl_lib->target_obj->attrs.fclose) (zl_lib->fp); zl_lib->fp = NULL; status = -EBADF; } } else { status = -EBADF; } return status; } /* * ======== name_hash ======== */ static u16 name_hash(void *key, u16 max_bucket) { u16 ret; u16 hash; char *name = (char *)key; DBC_REQUIRE(name != NULL); hash = 0; while (*name) { hash <<= 1; hash ^= *name++; } ret = hash % max_bucket; return ret; } /* * ======== name_match ======== */ static bool name_match(void *key, void *sp) { DBC_REQUIRE(key != NULL); DBC_REQUIRE(sp != NULL); if ((key != NULL) && (sp != NULL)) { if (strcmp((char *)key, ((struct dbll_symbol *)sp)->name) == 0) return true; } return false; } /* * ======== no_op ======== */ static int no_op(struct dynamic_loader_initialize *thisptr, void *bufr, ldr_addr locn, struct ldr_section_info *info, unsigned bytsize) { return 1; } /* * ======== sym_delete ======== */ static void sym_delete(void *value) { struct dbll_symbol *sp = (struct dbll_symbol *)value; kfree(sp->name); } /* * Dynamic Loader Functions */ /* dynamic_loader_stream */ /* * ======== dbll_read_buffer ======== */ static int dbll_read_buffer(struct dynamic_loader_stream *this, void *buffer, unsigned bufsize) { struct dbll_stream *pstream = (struct dbll_stream *)this; struct dbll_library_obj *lib; int bytes_read = 0; DBC_REQUIRE(this != NULL); lib = pstream->lib; DBC_REQUIRE(lib); if (lib != NULL) { bytes_read = (*(lib->target_obj->attrs.fread)) (buffer, 1, bufsize, lib->fp); } return bytes_read; } /* * ======== dbll_set_file_posn ======== */ static int dbll_set_file_posn(struct dynamic_loader_stream *this, unsigned int pos) { struct dbll_stream *pstream = (struct dbll_stream *)this; struct dbll_library_obj *lib; int status = 0; /* Success */ DBC_REQUIRE(this != NULL); lib = pstream->lib; DBC_REQUIRE(lib); if (lib != NULL) { status = (*(lib->target_obj->attrs.fseek)) (lib->fp, (long)pos, SEEK_SET); } return status; } /* dynamic_loader_sym */ /* * ======== dbll_find_symbol ======== */ static struct dynload_symbol *dbll_find_symbol(struct dynamic_loader_sym *this, const char *name) { struct dynload_symbol *ret_sym; struct ldr_symbol *ldr_sym = (struct ldr_symbol *)this; struct dbll_library_obj *lib; struct dbll_sym_val *dbll_sym = NULL; bool status = false; /* Symbol not found yet */ DBC_REQUIRE(this != NULL); lib = ldr_sym->lib; DBC_REQUIRE(lib); if (lib != NULL) { if (lib->target_obj->attrs.sym_lookup) { /* Check current lib + base lib + dep lib + * persistent lib */ status = (*(lib->target_obj->attrs.sym_lookup)) (lib->target_obj->attrs.sym_handle, lib->target_obj->attrs.sym_arg, lib->target_obj->attrs.rmm_handle, name, &dbll_sym); } else { /* Just check current lib for symbol */ status = dbll_get_addr((struct dbll_library_obj *)lib, (char *)name, &dbll_sym); if (!status) { status = dbll_get_c_addr((struct dbll_library_obj *) lib, (char *)name, &dbll_sym); } } } if (!status && gbl_search) dev_dbg(bridge, "%s: Symbol not found: %s\n", __func__, name); DBC_ASSERT((status && (dbll_sym != NULL)) || (!status && (dbll_sym == NULL))); ret_sym = (struct dynload_symbol *)dbll_sym; return ret_sym; } /* * ======== find_in_symbol_table ======== */ static struct dynload_symbol *find_in_symbol_table(struct dynamic_loader_sym *this, const char *name, unsigned moduleid) { struct dynload_symbol *ret_sym; struct ldr_symbol *ldr_sym = (struct ldr_symbol *)this; struct dbll_library_obj *lib; struct dbll_symbol *sym; DBC_REQUIRE(this != NULL); lib = ldr_sym->lib; DBC_REQUIRE(lib); DBC_REQUIRE(lib->sym_tab != NULL); sym = (struct dbll_symbol *)gh_find(lib->sym_tab, (char *)name); ret_sym = (struct dynload_symbol *)&sym->value; return ret_sym; } /* * ======== dbll_add_to_symbol_table ======== */ static struct dynload_symbol *dbll_add_to_symbol_table(struct dynamic_loader_sym *this, const char *name, unsigned module_id) { struct dbll_symbol *sym_ptr = NULL; struct dbll_symbol symbol; struct dynload_symbol *dbll_sym = NULL; struct ldr_symbol *ldr_sym = (struct ldr_symbol *)this; struct dbll_library_obj *lib; struct dynload_symbol *ret; DBC_REQUIRE(this != NULL); DBC_REQUIRE(name); lib = ldr_sym->lib; DBC_REQUIRE(lib); /* Check to see if symbol is already defined in symbol table */ if (!(lib->target_obj->attrs.base_image)) { gbl_search = false; dbll_sym = dbll_find_symbol(this, name); gbl_search = true; if (dbll_sym) { redefined_symbol = true; dev_dbg(bridge, "%s already defined in symbol table\n", name); return NULL; } } /* Allocate string to copy symbol name */ symbol.name = kzalloc(strlen((char *const)name) + 1, GFP_KERNEL); if (symbol.name == NULL) return NULL; if (symbol.name != NULL) { /* Just copy name (value will be filled in by dynamic loader) */ strncpy(symbol.name, (char *const)name, strlen((char *const)name) + 1); /* Add symbol to symbol table */ sym_ptr = (struct dbll_symbol *)gh_insert(lib->sym_tab, (void *)name, (void *)&symbol); if (sym_ptr == NULL) kfree(symbol.name); } if (sym_ptr != NULL) ret = (struct dynload_symbol *)&sym_ptr->value; else ret = NULL; return ret; } /* * ======== dbll_purge_symbol_table ======== */ static void dbll_purge_symbol_table(struct dynamic_loader_sym *this, unsigned module_id) { struct ldr_symbol *ldr_sym = (struct ldr_symbol *)this; struct dbll_library_obj *lib; DBC_REQUIRE(this != NULL); lib = ldr_sym->lib; DBC_REQUIRE(lib); /* May not need to do anything */ } /* * ======== allocate ======== */ static void *allocate(struct dynamic_loader_sym *this, unsigned memsize) { struct ldr_symbol *ldr_sym = (struct ldr_symbol *)this; struct dbll_library_obj *lib; void *buf; DBC_REQUIRE(this != NULL); lib = ldr_sym->lib; DBC_REQUIRE(lib); buf = kzalloc(memsize, GFP_KERNEL); return buf; } /* * ======== deallocate ======== */ static void deallocate(struct dynamic_loader_sym *this, void *mem_ptr) { struct ldr_symbol *ldr_sym = (struct ldr_symbol *)this; struct dbll_library_obj *lib; DBC_REQUIRE(this != NULL); lib = ldr_sym->lib; DBC_REQUIRE(lib); kfree(mem_ptr); } /* * ======== dbll_err_report ======== */ static void dbll_err_report(struct dynamic_loader_sym *this, const char *errstr, va_list args) { struct ldr_symbol *ldr_sym = (struct ldr_symbol *)this; struct dbll_library_obj *lib; char temp_buf[MAXEXPR]; DBC_REQUIRE(this != NULL); lib = ldr_sym->lib; DBC_REQUIRE(lib); vsnprintf((char *)temp_buf, MAXEXPR, (char *)errstr, args); dev_dbg(bridge, "%s\n", temp_buf); } /* dynamic_loader_allocate */ /* * ======== dbll_rmm_alloc ======== */ static int dbll_rmm_alloc(struct dynamic_loader_allocate *this, struct ldr_section_info *info, unsigned align) { struct dbll_alloc *dbll_alloc_obj = (struct dbll_alloc *)this; struct dbll_library_obj *lib; int status = 0; u32 mem_sect_type; struct rmm_addr rmm_addr_obj; s32 ret = true; unsigned stype = DLOAD_SECTION_TYPE(info->type); char *token = NULL; char *sz_sec_last_token = NULL; char *sz_last_token = NULL; char *sz_sect_name = NULL; char *psz_cur; s32 token_len = 0; s32 seg_id = -1; s32 req = -1; s32 count = 0; u32 alloc_size = 0; u32 run_addr_flag = 0; DBC_REQUIRE(this != NULL); lib = dbll_alloc_obj->lib; DBC_REQUIRE(lib); mem_sect_type = (stype == DLOAD_TEXT) ? DBLL_CODE : (stype == DLOAD_BSS) ? DBLL_BSS : DBLL_DATA; /* Attempt to extract the segment ID and requirement information from the name of the section */ DBC_REQUIRE(info->name); token_len = strlen((char *)(info->name)) + 1; sz_sect_name = kzalloc(token_len, GFP_KERNEL); sz_last_token = kzalloc(token_len, GFP_KERNEL); sz_sec_last_token = kzalloc(token_len, GFP_KERNEL); if (sz_sect_name == NULL || sz_sec_last_token == NULL || sz_last_token == NULL) { status = -ENOMEM; goto func_cont; } strncpy(sz_sect_name, (char *)(info->name), token_len); psz_cur = sz_sect_name; while ((token = strsep(&psz_cur, ":")) && *token != '\0') { strncpy(sz_sec_last_token, sz_last_token, strlen(sz_last_token) + 1); strncpy(sz_last_token, token, strlen(token) + 1); token = strsep(&psz_cur, ":"); count++; /* optimizes processing */ } /* If token is 0 or 1, and sz_sec_last_token is DYN_DARAM or DYN_SARAM, or DYN_EXTERNAL, then mem granularity information is present within the section name - only process if there are at least three tokens within the section name (just a minor optimization) */ if (count >= 3) strict_strtol(sz_last_token, 10, (long *)&req); if ((req == 0) || (req == 1)) { if (strcmp(sz_sec_last_token, "DYN_DARAM") == 0) { seg_id = 0; } else { if (strcmp(sz_sec_last_token, "DYN_SARAM") == 0) { seg_id = 1; } else { if (strcmp(sz_sec_last_token, "DYN_EXTERNAL") == 0) seg_id = 2; } } } func_cont: kfree(sz_sect_name); sz_sect_name = NULL; kfree(sz_last_token); sz_last_token = NULL; kfree(sz_sec_last_token); sz_sec_last_token = NULL; if (mem_sect_type == DBLL_CODE) alloc_size = info->size + GEM_L1P_PREFETCH_SIZE; else alloc_size = info->size; if (info->load_addr != info->run_addr) run_addr_flag = 1; /* TODO - ideally, we can pass the alignment requirement also * from here */ if (lib != NULL) { status = (lib->target_obj->attrs.alloc) (lib->target_obj->attrs. rmm_handle, mem_sect_type, alloc_size, align, (u32 *) &rmm_addr_obj, seg_id, req, false); } if (status) { ret = false; } else { /* RMM gives word address. Need to convert to byte address */ info->load_addr = rmm_addr_obj.addr * DSPWORDSIZE; if (!run_addr_flag) info->run_addr = info->load_addr; info->context = (u32) rmm_addr_obj.segid; dev_dbg(bridge, "%s: %s base = 0x%x len = 0x%x, " "info->run_addr 0x%x, info->load_addr 0x%x\n", __func__, info->name, info->load_addr / DSPWORDSIZE, info->size / DSPWORDSIZE, info->run_addr, info->load_addr); } return ret; } /* * ======== rmm_dealloc ======== */ static void rmm_dealloc(struct dynamic_loader_allocate *this, struct ldr_section_info *info) { struct dbll_alloc *dbll_alloc_obj = (struct dbll_alloc *)this; struct dbll_library_obj *lib; u32 segid; int status = 0; unsigned stype = DLOAD_SECTION_TYPE(info->type); u32 mem_sect_type; u32 free_size = 0; mem_sect_type = (stype == DLOAD_TEXT) ? DBLL_CODE : (stype == DLOAD_BSS) ? DBLL_BSS : DBLL_DATA; DBC_REQUIRE(this != NULL); lib = dbll_alloc_obj->lib; DBC_REQUIRE(lib); /* segid was set by alloc function */ segid = (u32) info->context; if (mem_sect_type == DBLL_CODE) free_size = info->size + GEM_L1P_PREFETCH_SIZE; else free_size = info->size; if (lib != NULL) { status = (lib->target_obj->attrs.free) (lib->target_obj->attrs. sym_handle, segid, info->load_addr / DSPWORDSIZE, free_size, false); } } /* dynamic_loader_initialize */ /* * ======== connect ======== */ static int connect(struct dynamic_loader_initialize *this) { return true; } /* * ======== read_mem ======== * This function does not need to be implemented. */ static int read_mem(struct dynamic_loader_initialize *this, void *buf, ldr_addr addr, struct ldr_section_info *info, unsigned nbytes) { struct dbll_init_obj *init_obj = (struct dbll_init_obj *)this; struct dbll_library_obj *lib; int bytes_read = 0; DBC_REQUIRE(this != NULL); lib = init_obj->lib; DBC_REQUIRE(lib); /* Need bridge_brd_read function */ return bytes_read; } /* * ======== write_mem ======== */ static int write_mem(struct dynamic_loader_initialize *this, void *buf, ldr_addr addr, struct ldr_section_info *info, unsigned bytes) { struct dbll_init_obj *init_obj = (struct dbll_init_obj *)this; struct dbll_library_obj *lib; struct dbll_tar_obj *target_obj; struct dbll_sect_info sect_info; u32 mem_sect_type; bool ret = true; DBC_REQUIRE(this != NULL); lib = init_obj->lib; if (!lib) return false; target_obj = lib->target_obj; mem_sect_type = (DLOAD_SECTION_TYPE(info->type) == DLOAD_TEXT) ? DBLL_CODE : DBLL_DATA; if (target_obj && target_obj->attrs.write) { ret = (*target_obj->attrs.write) (target_obj->attrs.input_params, addr, buf, bytes, mem_sect_type); if (target_obj->attrs.log_write) { sect_info.name = info->name; sect_info.sect_run_addr = info->run_addr; sect_info.sect_load_addr = info->load_addr; sect_info.size = info->size; sect_info.type = mem_sect_type; /* Pass the information about what we've written to * another module */ (*target_obj->attrs.log_write) (target_obj->attrs. log_write_handle, §_info, addr, bytes); } } return ret; } /* * ======== fill_mem ======== * Fill bytes of memory at a given address with a given value by * writing from a buffer containing the given value. Write in * sets of MAXEXPR (128) bytes to avoid large stack buffer issues. */ static int fill_mem(struct dynamic_loader_initialize *this, ldr_addr addr, struct ldr_section_info *info, unsigned bytes, unsigned val) { bool ret = true; char *pbuf; struct dbll_library_obj *lib; struct dbll_init_obj *init_obj = (struct dbll_init_obj *)this; DBC_REQUIRE(this != NULL); lib = init_obj->lib; pbuf = NULL; /* Pass the NULL pointer to write_mem to get the start address of Shared memory. This is a trick to just get the start address, there is no writing taking place with this Writemem */ if ((lib->target_obj->attrs.write) != (dbll_write_fxn) no_op) write_mem(this, &pbuf, addr, info, 0); if (pbuf) memset(pbuf, val, bytes); return ret; } /* * ======== execute ======== */ static int execute(struct dynamic_loader_initialize *this, ldr_addr start) { struct dbll_init_obj *init_obj = (struct dbll_init_obj *)this; struct dbll_library_obj *lib; bool ret = true; DBC_REQUIRE(this != NULL); lib = init_obj->lib; DBC_REQUIRE(lib); /* Save entry point */ if (lib != NULL) lib->entry = (u32) start; return ret; } /* * ======== release ======== */ static void release(struct dynamic_loader_initialize *this) { } #ifdef CONFIG_TIDSPBRIDGE_BACKTRACE /** * find_symbol_context - Basic symbol context structure * @address: Symbol Address * @offset_range: Offset range where the search for the DSP symbol * started. * @cur_best_offset: Best offset to start looking for the DSP symbol * @sym_addr: Address of the DSP symbol * @name: Symbol name * */ struct find_symbol_context { /* input */ u32 address; u32 offset_range; /* state */ u32 cur_best_offset; /* output */ u32 sym_addr; char name[120]; }; /** * find_symbol_callback() - Validates symbol address and copies the symbol name * to the user data. * @elem: dsp library context * @user_data: Find symbol context * */ void find_symbol_callback(void *elem, void *user_data) { struct dbll_symbol *symbol = elem; struct find_symbol_context *context = user_data; u32 symbol_addr = symbol->value.value; u32 offset = context->address - symbol_addr; /* * Address given should be greater than symbol address, * symbol address should be within specified range * and the offset should be better than previous one */ if (context->address >= symbol_addr && symbol_addr < (u32)-1 && offset < context->cur_best_offset) { context->cur_best_offset = offset; context->sym_addr = symbol_addr; strncpy(context->name, symbol->name, sizeof(context->name)); } return; } /** * dbll_find_dsp_symbol() - This function retrieves the dsp symbol from the dsp binary. * @zl_lib: DSP binary obj library pointer * @address: Given address to find the dsp symbol * @offset_range: offset range to look for dsp symbol * @sym_addr_output: Symbol Output address * @name_output: String with the dsp symbol * * This function retrieves the dsp symbol from the dsp binary. */ bool dbll_find_dsp_symbol(struct dbll_library_obj *zl_lib, u32 address, u32 offset_range, u32 *sym_addr_output, char *name_output) { bool status = false; struct find_symbol_context context; context.address = address; context.offset_range = offset_range; context.cur_best_offset = offset_range; context.sym_addr = 0; context.name[0] = '\0'; gh_iterate(zl_lib->sym_tab, find_symbol_callback, &context); if (context.name[0]) { status = true; strcpy(name_output, context.name); *sym_addr_output = context.sym_addr; } return status; } #endif