summaryrefslogtreecommitdiffstats
path: root/rbutil/mkrk27boot/ata-sim.c
diff options
context:
space:
mode:
authorAndrew Ryabinin <ryabinin.a.a@gmail.com>2012-10-10 12:17:48 +0400
committerAndrew Ryabinin <ryabinin.a.a@gmail.com>2012-10-10 12:58:37 +0400
commit097352a3ecf608f0934e1628c6b3cb783cf65b6c (patch)
treee7dbd731c9e6401fbaa80d826201c6a540ec2dbf /rbutil/mkrk27boot/ata-sim.c
parent71778bd21ee57d105a58fa93d7a295c5dc0e3b5c (diff)
downloadrockbox-097352a3ecf608f0934e1628c6b3cb783cf65b6c.tar.gz
rockbox-097352a3ecf608f0934e1628c6b3cb783cf65b6c.tar.bz2
rockbox-097352a3ecf608f0934e1628c6b3cb783cf65b6c.zip
Introduce mkrk27boot - tool for patching bootloader images of rk27xx targets.mkrk27boot_v1.0
Change-Id: I37e15111eb9e761b8c6c25f9c1f65a827894a192
Diffstat (limited to 'rbutil/mkrk27boot/ata-sim.c')
-rw-r--r--rbutil/mkrk27boot/ata-sim.c122
1 files changed, 122 insertions, 0 deletions
diff --git a/rbutil/mkrk27boot/ata-sim.c b/rbutil/mkrk27boot/ata-sim.c
new file mode 100644
index 0000000000..129c4b36a9
--- /dev/null
+++ b/rbutil/mkrk27boot/ata-sim.c
@@ -0,0 +1,122 @@
+/***************************************************************************
+ * __________ __ ___.
+ * Open \______ \ ____ ____ | | _\_ |__ _______ ___
+ * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
+ * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
+ * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
+ * \/ \/ \/ \/ \/
+ * $Id:$
+ *
+ * Copyright (C) 2012 by Andrew Ryabinin
+ *
+ * major portion of code is taken from firmware/test/fat/ata-sim.c
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * as published by the Free Software Foundation; either version 2
+ * of the License, or (at your option) any later version.
+ *
+ * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
+ * KIND, either express or implied.
+ *
+ ****************************************************************************/
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <stdarg.h>
+#include "debug.h"
+#include "dir.h"
+
+#define BLOCK_SIZE 512
+
+static FILE* file;
+
+extern char *img_filename;
+
+void mutex_init(struct mutex* l) {}
+void mutex_lock(struct mutex* l) {}
+void mutex_unlock(struct mutex* l) {}
+
+void panicf( char *fmt, ...) {
+ va_list ap;
+ va_start( ap, fmt );
+ fprintf(stderr,"***PANIC*** ");
+ vfprintf(stderr, fmt, ap );
+ va_end( ap );
+ exit(1);
+}
+
+void debugf(const char *fmt, ...) {
+ va_list ap;
+ va_start( ap, fmt );
+ fprintf(stderr,"DEBUGF: ");
+ vfprintf( stderr, fmt, ap );
+ va_end( ap );
+}
+
+void ldebugf(const char* file, int line, const char *fmt, ...) {
+ va_list ap;
+ va_start( ap, fmt );
+ fprintf( stderr, "%s:%d ", file, line );
+ vfprintf( stderr, fmt, ap );
+ va_end( ap );
+}
+
+int storage_read_sectors(unsigned long start, int count, void* buf)
+{
+ if ( count > 1 )
+ DEBUGF("[Reading %d blocks: 0x%lx to 0x%lx]\n",
+ count, start, start+count-1);
+ else
+ DEBUGF("[Reading block 0x%lx]\n", start);
+
+ if(fseek(file,start*BLOCK_SIZE,SEEK_SET)) {
+ perror("fseek");
+ return -1;
+ }
+ if(!fread(buf,BLOCK_SIZE,count,file)) {
+ DEBUGF("ata_write_sectors(0x%lx, 0x%x, %p)\n", start, count, buf );
+ perror("fread");
+ panicf("Disk error\n");
+ }
+ return 0;
+}
+
+int storage_write_sectors(unsigned long start, int count, void* buf)
+{
+ if ( count > 1 )
+ DEBUGF("[Writing %d blocks: 0x%lx to 0x%lx]\n",
+ count, start, start+count-1);
+ else
+ DEBUGF("[Writing block 0x%lx]\n", start);
+
+ if (start == 0)
+ panicf("Writing on sector 0!\n");
+
+ if(fseek(file,start*BLOCK_SIZE,SEEK_SET)) {
+ perror("fseek");
+ return -1;
+ }
+ if(!fwrite(buf,BLOCK_SIZE,count,file)) {
+ DEBUGF("ata_write_sectors(0x%lx, 0x%x, %p)\n", start, count, buf );
+ perror("fwrite");
+ panicf("Disk error\n");
+ }
+ return 0;
+}
+
+int ata_init(void)
+{
+ file=fopen(img_filename,"rb+");
+ if(!file) {
+ fprintf(stderr, "read_disk() - Could not find \"%s\"\n",img_filename);
+ return -1;
+ }
+ return 0;
+}
+
+void ata_exit(void)
+{
+ fclose(file);
+}