diff gsm-fw/L1/cust0/pirelli.c @ 890:452a4aea3fc5

gsm-fw: implemented reading of Pirelli's factory calibration records
author Space Falcon <falcon@ivan.Harhan.ORG>
date Mon, 29 Jun 2015 21:45:23 +0000
parents
children
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/gsm-fw/L1/cust0/pirelli.c	Mon Jun 29 21:45:23 2015 +0000
@@ -0,0 +1,84 @@
+/*
+ * This module is a FreeCalypso addition.  Here we implement
+ * retrieval of Pirelli's factory calibration and IMEI records
+ * from their factory data block.
+ */
+
+#include <string.h>
+#include "config.h"
+#include "sys_types.h"
+#include "../../services/ffs/ffs.h"
+#include "../../services/ffs/core.h"	/* for ffs_begin() and ffs_end() */
+
+#define	FACTORY_BLOCK_BASE_ADDR	0x027F0000
+
+static effs_t
+pirelli_chksum(uint8 *addr, T_FFS_SIZE size)
+{
+	uint8 accum = 0;
+
+	for (; size; size--)
+		accum += *addr++;
+	if (accum == *addr)
+		return EFFS_OK;
+	else
+		return EFFS_CORRUPTED;
+}
+
+pirelli_read_factory_record(uint32 offset, void *userbuf, T_FFS_SIZE size,
+			    int has_chksum)
+{
+	effs_t rc;
+	uint8 *flash_record = (uint8 *) FACTORY_BLOCK_BASE_ADDR + offset;
+
+	rc = ffs_begin();
+	if (rc != EFFS_OK)
+		return(rc);
+	if (has_chksum)
+		rc = pirelli_chksum(flash_record, size);
+	if (rc == EFFS_OK)
+		bcopy(flash_record, userbuf, size);
+	return ffs_end(rc);
+}
+
+static const struct calmap {
+	uint32	offset;
+	char	*ti_equiv;
+} pirelli_cal_map[] = {
+	{0x06E5, "/sys/adccal"},
+	{0x072B, "/gsm/rf/tx/ramps.900"},
+	{0x092C, "/gsm/rf/tx/levels.900"},
+	{0x09AD, "/gsm/rf/tx/calchan.900"},
+	{0x0A2E, "/gsm/rf/tx/ramps.1800"},
+	{0x0C2F, "/gsm/rf/tx/levels.1800"},
+	{0x0CB0, "/gsm/rf/tx/calchan.1800"},
+	{0x0D31, "/gsm/rf/tx/ramps.1900"},
+	{0x0F32, "/gsm/rf/tx/levels.1900"},
+	{0x0FB3, "/gsm/rf/tx/calchan.1900"},
+	{0x10AF, "/gsm/rf/rx/calchan.900"},
+	{0x10D8, "/gsm/rf/rx/agcparams.900"},
+	{0x10E1, "/gsm/rf/rx/calchan.1800"},
+	{0x110A, "/gsm/rf/rx/agcparams.1800"},
+	{0x1113, "/gsm/rf/rx/calchan.1900"},
+	{0x113C, "/gsm/rf/rx/agcparams.1900"},
+	{0, 0}
+};
+
+pirelli_cal_fread(const char *name, void *userbuf, T_FFS_SIZE size)
+{
+	int rc;
+	const struct calmap *map;
+
+	/* try FFS first, so FreeCalypso user can override factory prog */
+	rc = ffs_file_read(name, userbuf, size);
+	if (rc >= 0)
+		return EFFS_OK;
+	/* does the sought file correspond to a Pirelli factory data record? */
+	for (map = pirelli_cal_map; map->ti_equiv; map++)
+		if (!strcmp(map->ti_equiv, name))
+			break;
+	if (!map->offset)	/* not found */
+		return rc;	/* return error code from FFS */
+	/* found it */
+	return pirelli_read_factory_record(map->offset, userbuf, size, 1);
+}