view rvinterf/etmsync/pirhackinit.c @ 997:c7ca69bf84f3

gsm-fw: trivial support for c11x target
author Mychaela Falconia <falcon@ivan.Harhan.ORG>
date Sat, 05 Mar 2016 05:10:49 +0000
parents 7cb0b32f1997
children
line wrap: on
line source

/*
 * This fc-pirhackinit utility is highly specific to the TCS211-on-Pirelli
 * exercise.  DO NOT run it against Pirelli's stock firmware, nor is it needed
 * when using our full-source FreeCalypso firmware.
 */

#include <sys/types.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <strings.h>
#include "etm.h"
#include "ffs.h"
#include "tmffs2.h"
#include "localtypes.h"
#include "exitcodes.h"

extern u_char pirelli_imeisv[8];

write_pcm_imei()
{
	static char destfile[] = "/pcm/IMEI";
	u_char swapped[8];
	int i, d1, d2;

	printf("Writing %s\n", destfile);
	for (i = 0; i < 8; i++) {
		d1 = pirelli_imeisv[i] >> 4;
		d2 = pirelli_imeisv[i] & 0xF;
		swapped[i] = (d2 << 4) | d1;
	}
	return do_short_fwrite(destfile, swapped, 8);
}

read_mem_region(memaddr, databuf, total_bytes)
	u32 memaddr;
	u_char *databuf;
{
	int chunk, remain, rc;

	for (remain = total_bytes; remain; remain -= chunk) {
		chunk = remain;
		if (chunk > MAX_MEMREAD_BYTES)
			chunk = MAX_MEMREAD_BYTES;
		rc = do_memory_read(memaddr, databuf, chunk);
		if (rc)
			return(rc);
		memaddr += chunk;
		databuf += chunk;
	}
	return(0);
}

write_buf_to_file(pathname, data, datalen)
	char *pathname;
	u_char *data;
{
	int tfd, rc, chunk, remain;

	if (datalen <= max_short_file_write(pathname))
		return do_short_fwrite(pathname, data, datalen);
	/* do it the long way */
	rc = fd_open(pathname, FFS_O_WRONLY | FFS_O_CREATE | FFS_O_TRUNC, &tfd);
	if (rc)
		return(rc);
	for (remain = datalen; remain; remain -= chunk) {
		chunk = remain;
		if (chunk > 240)
			chunk = 240;
		rc = fd_write(tfd, data, chunk);
		if (rc) {
			fd_close(tfd);
			return(rc);
		}
		data += chunk;
	}
	return fd_close(tfd);
}

copy_calib_record(memaddr, pathname, size)
	u32 memaddr;
	char *pathname;
	int size;
{
	u_char *buf;
	int rc;

	buf = malloc(size);
	if (!buf) {
		perror("malloc");
		exit(ERROR_UNIX);
	}
	rc = read_mem_region(memaddr, buf, size);
	if (rc) {
		free(buf);
		return(rc);
	}
	rc = write_buf_to_file(pathname, buf, size);
	free(buf);
	return(rc);
}

static struct calmap {
	u32	offset;
	int	size;
	char	*ti_equiv;
} pirelli_cal_map[] = {
	{0x06E5, 36,  "/sys/adccal"},
	{0x072B, 512, "/gsm/rf/tx/ramps.900"},
	{0x092C, 128, "/gsm/rf/tx/levels.900"},
	{0x09AD, 128, "/gsm/rf/tx/calchan.900"},
	{0x0A2E, 512, "/gsm/rf/tx/ramps.1800"},
	{0x0C2F, 128, "/gsm/rf/tx/levels.1800"},
	{0x0CB0, 128, "/gsm/rf/tx/calchan.1800"},
	{0x0D31, 512, "/gsm/rf/tx/ramps.1900"},
	{0x0F32, 128, "/gsm/rf/tx/levels.1900"},
	{0x0FB3, 128, "/gsm/rf/tx/calchan.1900"},
	{0x10AF, 40,  "/gsm/rf/rx/calchan.900"},
	{0x10D8, 8,   "/gsm/rf/rx/agcparams.900"},
	{0x10E1, 40,  "/gsm/rf/rx/calchan.1800"},
	{0x110A, 8,   "/gsm/rf/rx/agcparams.1800"},
	{0x1113, 40,  "/gsm/rf/rx/calchan.1900"},
	{0x113C, 8,   "/gsm/rf/rx/agcparams.1900"},
	{0, 0, 0}
};

copy_calib_data()
{
	struct calmap *tp;
	int rc;

	printf("Copying calibration records to FFS\n");
	for (tp = pirelli_cal_map; tp->size; tp++) {
		rc = copy_calib_record(0x027F0000 + tp->offset, tp->ti_equiv,
					tp->size);
		if (rc)
			return(rc);
	}
	return(0);
}

single_op_main()
{
	int rc;

	rc = get_pirelli_imei();
	if (rc)
		return(rc);
	printf("Creating TCS211 file system directories\n");
	rc = create_std_dirs();
	if (rc)
		return(rc);
	rc = write_pcm_imei();
	if (rc)
		return(rc);
	rc = copy_calib_data();
	if (rc)
		return(rc);
	return set_rfcap("tri900");
}