Newer
Older
/***************************************************************************
* Copyright (C) 2007-2008 by yvind Harboe *
* *
* 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 program is distributed in the hope that it will be useful, *
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
* GNU General Public License for more details. *
* *
* You should have received a copy of the GNU General Public License *
* along with this program; if not, write to the *
* Free Software Foundation, Inc., *
* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
***************************************************************************/
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include "log.h"
#include "types.h"
#include "jtag.h"
#include "configuration.h"
#include "xsvf.h"
#include "target.h"
#include "flash.h"
#include "nand.h"
#include "pld.h"
#include "command.h"
#include "server.h"
#include "telnet_server.h"
#include "gdb_server.h"
#include <time_support.h>
#include <sys/time.h>
#include <strings.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <errno.h>
#include <cyg/io/flash.h>
#include <pkgconf/fs_jffs2.h> // Address of JFFS2
#include <network.h>
#include <fcntl.h>
#include <sys/stat.h>
#include <cyg/fileio/fileio.h>
#include <dirent.h>
#include <cyg/athttpd/http.h>
#include <cyg/athttpd/socket.h>
#include <cyg/athttpd/handler.h>
#include <cyg/athttpd/cgi.h>
#include <cyg/athttpd/forms.h>
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
#include <cyg/hal/hal_diag.h>
#include <cyg/kernel/kapi.h>
#include <cyg/io/serialio.h>
#include <cyg/io/io.h>
#include <netinet/tcp.h>
#include "rom.h"
#include <sys/ioctl.h>
#include <sys/socket.h>
#include <netinet/in.h>
#include <net/if.h>
#include <arpa/inet.h>
#include <sys/types.h>
#include <sys/socket.h>
#include <netdb.h>
#include <netinet/in.h>
#include <unistd.h>
#include <arpa/inet.h>
#include <stdio.h>
#include <ifaddrs.h>
#include <string.h>
#include <unistd.h>
#include <stdio.h>
#define MAX_IFS 64
#if defined(CYGPKG_NET_FREEBSD_STACK)
#include <tftp_support.h>
/* posix compatibility broken*/
struct tftpd_fileops fileops =
{
(int (*)(const char *, int))open,
close,
(int (*)(int, const void *, int))write,
( int (*)(int, void *, int))read
};
#endif
void diag_write(char *buf, int len)
{
int j;
for (j = 0; j < len; j++)
{
diag_printf("%c", buf[j]);
}
}
static bool serialLog = true;
static bool writeLog = true;
extern flash_driver_t *flash_drivers[];
extern target_type_t *target_types[];
#ifdef CYGPKG_PROFILE_GPROF
#include <cyg/profile/profile.h>
extern char _stext, _etext; // Defined by the linker
static char *start_of_code=&_stext;
static char *end_of_code=&_etext;
void start_profile(void)
{
// This starts up the system-wide profiling, gathering
// profile information on all of the code, with a 16 byte
// "bucket" size, at a rate of 100us/profile hit.
// Note: a bucket size of 16 will give pretty good function
// resolution. Much smaller and the buffer becomes
// much too large for very little gain.
// Note: a timer period of 100us is also a reasonable
// compromise. Any smaller and the overhead of
// handling the timter (profile) interrupt could
// swamp the system. A fast processor might get
// by with a smaller value, but a slow one could
// even be swamped by this value. If the value is
// too large, the usefulness of the profile is reduced.
// no more interrupts than 1/10ms.
//profile_on((void *)0, (void *)0x40000, 16, 10000); // SRAM

oharboe
committed
// profile_on(0, &_etext, 16, 10000); // SRAM & DRAM
profile_on(start_of_code, end_of_code, 16, 10000); // Nios DRAM
}
#endif
extern int eth0_up;
static FILE *log;
static char reboot_stack[2048];

oharboe
committed
static void zylinjtag_reboot(cyg_addrword_t data)
{
serialLog = true;
diag_printf("Rebooting in 100 ticks..\n");
cyg_thread_delay(100);
diag_printf("Unmounting /config..\n");
umount("/config");
diag_printf("Rebooting..\n");
HAL_PLATFORM_RESET();
}
static cyg_thread zylinjtag_thread_object;
static cyg_handle_t zylinjtag_thread_handle;
void reboot(void)
{

oharboe
committed
cyg_thread_create(1, zylinjtag_reboot, (cyg_addrword_t) 0, "reboot Thread",
(void *) reboot_stack, sizeof(reboot_stack),
&zylinjtag_thread_handle, &zylinjtag_thread_object);
cyg_thread_resume(zylinjtag_thread_handle);
}

oharboe
committed
int configuration_output_handler(struct command_context_s *context,
const char* line)
{
diag_printf("%s", line);
return ERROR_OK;
}

oharboe
committed
int zy1000_configuration_output_handler_log(struct command_context_s *context,
const char* line)
{
LOG_USER_N("%s", line);
return ERROR_OK;
}
#ifdef CYGPKG_PROFILE_GPROF
extern void start_profile(void);
externC void phi_init_all_network_interfaces(void);
command_context_t *cmd_ctx;
static bool webRunning = false;
void keep_webserver(void)
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
{
// Target initialisation is only attempted at startup, so we sleep forever and
// let the http server bail us out(i.e. get config files set up).
diag_printf("OpenOCD has invoked exit().\n"
"Use web server to correct any configuration settings and reboot.\n");
if (!webRunning)
reboot();
// exit() will terminate the current thread and we we'll then sleep eternally or
// we'll have a reboot scheduled.
}
extern void printDccChar(char c);
static char logBuffer[128 * 1024];
static const int logSize = sizeof(logBuffer);
int writePtr = 0;
int logCount = 0;
void _zylinjtag_diag_write_char(char c, void **param)
{
if (writeLog)
{
logBuffer[writePtr] = c;
writePtr = (writePtr + 1) % logSize;
logCount++;
}
if (serialLog)
{
if (c == '\n')
{
HAL_DIAG_WRITE_CHAR('\r');
}
HAL_DIAG_WRITE_CHAR(c);
}

oharboe
committed
void copyfile(char *name2, char *name1);

oharboe
committed
void copydir(char *name, char *destdir);
#if 0
MTAB_ENTRY( romfs_mte1,
"/rom",
"romfs",
"",
(CYG_ADDRWORD) &filedata[0] );
#endif
void openocd_sleep_prelude(void)
{
cyg_mutex_unlock(&httpstate.jim_lock);
}
void openocd_sleep_postlude(void)
{
cyg_mutex_lock(&httpstate.jim_lock);
}
void format(void)
{
diag_printf("Formatting JFFS2...\n");
cyg_io_handle_t handle;
Cyg_ErrNo err;
err = cyg_io_lookup(CYGDAT_IO_FLASH_BLOCK_DEVICE_NAME_1, &handle);
if (err != ENOERR)
{
diag_printf("Flash Error cyg_io_lookup: %d\n", err);
reboot();
}
cyg_uint32 len;
cyg_io_flash_getconfig_devsize_t ds;

oharboe
committed
len = sizeof(ds);
err = cyg_io_get_config(handle, CYG_IO_GET_CONFIG_FLASH_DEVSIZE, &ds, &len);
if (err != ENOERR)
{
diag_printf("Flash error cyg_io_get_config %d\n", err);
reboot();
}
cyg_io_flash_getconfig_erase_t e;
void *err_addr;

oharboe
committed
len = sizeof(e);
e.offset = 0;
e.len = ds.dev_size;
e.err_address = &err_addr;
diag_printf("Formatting 0x%08x bytes\n", ds.dev_size);

oharboe
committed
err = cyg_io_get_config(handle, CYG_IO_GET_CONFIG_FLASH_ERASE, &e, &len);
if (err != ENOERR)
{
diag_printf("Flash erase error %d offset 0x%p\n", err, err_addr);
reboot();
}
diag_printf("Flash formatted successfully\n");
reboot();
}

oharboe
committed
static int zylinjtag_Jim_Command_format_jffs2(Jim_Interp *interp, int argc,
Jim_Obj * const *argv)
{
if (argc != 1)
{
return JIM_ERR;
}
format();

oharboe
committed
for (;;)
;
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
static int zylinjtag_Jim_Command_threads(Jim_Interp *interp, int argc,
Jim_Obj * const *argv)
{
cyg_handle_t thread = 0;
cyg_uint16 id = 0;
Jim_Obj *threads = Jim_NewListObj(interp, NULL, 0);
/* Loop over the threads, and generate a table row for
* each.
*/
while (cyg_thread_get_next(&thread, &id))
{
Jim_Obj *threadObj = Jim_NewListObj(interp, NULL, 0);
cyg_thread_info info;
char *state_string;
cyg_thread_get_info(thread, id, &info);
if (info.name == NULL)
info.name = "<no name>";
Jim_ListAppendElement(interp, threadObj, Jim_NewStringObj(interp,
info.name, strlen(info.name)));
/* Translate the state into a string.
*/
if (info.state == 0)
state_string = "RUN";
else if (info.state & 0x04)
state_string = "SUSP";
else
switch (info.state & 0x1b)
{
case 0x01:
state_string = "SLEEP";
break;
case 0x02:
state_string = "CNTSLEEP";
break;
case 0x08:
state_string = "CREATE";
break;
case 0x10:
state_string = "EXIT";
break;
default:
state_string = "????";
break;
}
Jim_ListAppendElement(interp, threadObj, Jim_NewStringObj(interp,
state_string, strlen(state_string)));

oharboe
committed
Jim_ListAppendElement(interp, threadObj, Jim_NewIntObj(interp, id));
Jim_ListAppendElement(interp, threadObj, Jim_NewIntObj(interp,
info.set_pri));
Jim_ListAppendElement(interp, threadObj, Jim_NewIntObj(interp,
info.cur_pri));
Jim_ListAppendElement(interp, threads, threadObj);
}

oharboe
committed
Jim_SetResult(interp, threads);

oharboe
committed
static int zylinjtag_Jim_Command_log(Jim_Interp *interp, int argc,
Jim_Obj * const *argv)
{
Jim_Obj *tclOutput = Jim_NewStringObj(interp, "", 0);
if (logCount >= logSize)
{

oharboe
committed
Jim_AppendString(httpstate.jim_interp, tclOutput, logBuffer + logCount
% logSize, logSize - logCount % logSize);
}
Jim_AppendString(httpstate.jim_interp, tclOutput, logBuffer, writePtr);
Jim_SetResult(interp, tclOutput);
return JIM_OK;
}

oharboe
committed
static int zylinjtag_Jim_Command_reboot(Jim_Interp *interp, int argc,
Jim_Obj * const *argv)
{
reboot();
return JIM_OK;
}
extern Jim_Interp *interp;
static void zylinjtag_startNetwork(void)
{
// Bring TCP/IP up immediately before we're ready to accept commands.
//
// That is as soon as a PING responds, we're accepting telnet sessions.
#if defined(CYGPKG_NET_FREEBSD_STACK)
phi_init_all_network_interfaces();
#else
lwip_init();
#endif
if (!eth0_up)
{
diag_printf("Network not up and running\n");
exit(-1);
}
#if defined(CYGPKG_NET_FREEBSD_STACK)
/*start TFTP*/
tftpd_start(69, &fileops);
#endif
cyg_httpd_init_tcl_interpreter();
interp = httpstate.jim_interp;

oharboe
committed
Jim_CreateCommand(httpstate.jim_interp, "log", zylinjtag_Jim_Command_log,
NULL, NULL);
Jim_CreateCommand(httpstate.jim_interp, "reboot",
zylinjtag_Jim_Command_reboot, NULL, NULL);
Jim_CreateCommand(httpstate.jim_interp, "threads",
zylinjtag_Jim_Command_threads, NULL, NULL);
Jim_CreateCommand(httpstate.jim_interp, "format_jffs2",
zylinjtag_Jim_Command_format_jffs2, NULL, NULL);
cyg_httpd_start();
webRunning = true;
diag_printf("Web server running\n");
int s;
struct ifreq ifr;
s = socket(AF_INET, SOCK_DGRAM, 0);
if (s >= 0)
{
strcpy(ifr.ifr_name, "eth0");
int res;
res = ioctl(s, SIOCGIFHWADDR, &ifr);
close(s);
if (res < 0)
{
diag_printf("Can't obtain MAC address\n");
reboot();
}
}
sprintf(hwaddr, "%02x:%02x:%02x:%02x:%02x:%02x",
(int) ((unsigned char *) &ifr.ifr_hwaddr.sa_data)[0],
(int) ((unsigned char *) &ifr.ifr_hwaddr.sa_data)[1],
(int) ((unsigned char *) &ifr.ifr_hwaddr.sa_data)[2],
(int) ((unsigned char *) &ifr.ifr_hwaddr.sa_data)[3],
(int) ((unsigned char *) &ifr.ifr_hwaddr.sa_data)[4],
(int) ((unsigned char *) &ifr.ifr_hwaddr.sa_data)[5]);

oharboe
committed
discover_message
= alloc_printf("ZY1000 Zylin JTAG debugger MAC %s", hwaddr);

oharboe
committed
static void print_exception_handler(cyg_addrword_t data, cyg_code_t exception,
cyg_addrword_t info)
{
writeLog = false;
serialLog = true;
char *infoStr = "unknown";
switch (exception)
{
case CYGNUM_HAL_VECTOR_UNDEF_INSTRUCTION:

oharboe
committed
infoStr = "undefined instruction";
break;
case CYGNUM_HAL_VECTOR_SOFTWARE_INTERRUPT:

oharboe
committed
infoStr = "software interrupt";
break;
case CYGNUM_HAL_VECTOR_ABORT_PREFETCH:

oharboe
committed
infoStr = "abort prefetch";
break;

oharboe
committed
infoStr = "abort data";
break;
default:
break;
}
diag_printf("Exception: %08x(%s) %08x\n", exception, infoStr, info);
diag_printf("Dumping log\n---\n");
if (logCount >= logSize)
{
diag_write(logBuffer + logCount % logSize, logSize - logCount % logSize);
}
diag_write(logBuffer, writePtr);
diag_printf("---\nLogdump complete.\n");
diag_printf("Exception: %08x(%s) %08x\n", exception, infoStr, info);
diag_printf("\n---\nRebooting\n");
HAL_PLATFORM_RESET();
}
static void setHandler(cyg_code_t exception)
{
cyg_exception_handler_t *old_handler;
cyg_addrword_t old_data;

oharboe
committed
cyg_exception_set_handler(exception, print_exception_handler, 0,
&old_handler, &old_data);
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
}
static cyg_thread zylinjtag_uart_thread_object;
static cyg_handle_t zylinjtag_uart_thread_handle;
static char uart_stack[4096];
static char forwardBuffer[1024]; // NB! must be smaller than a TCP/IP packet!!!!!
static char backwardBuffer[1024];
void setNoDelay(int session, int flag)
{
#if 1
// This decreases latency dramatically for e.g. GDB load which
// does not have a sliding window protocol
//
// Can cause *lots* of TCP/IP packets to be sent and it would have
// to be enabled/disabled on the fly to avoid the CPU being
// overloaded...
setsockopt(session, /* socket affected */
IPPROTO_TCP, /* set option at TCP level */
TCP_NODELAY, /* name of option */
(char *) &flag, /* the cast is historical
cruft */
sizeof(int)); /* length of option value */
#endif
}
struct
{
int req;
int actual;
int req2;
int actual2;
} tcpipSent[512 * 1024];
int cur;

oharboe
committed
static void zylinjtag_uart(cyg_addrword_t data)
{
int so_reuseaddr_option = 1;
int fd;
if ((fd = socket(AF_INET, SOCK_STREAM, 0)) == -1)
{
LOG_ERROR("error creating socket: %s", strerror(errno));
exit(-1);
}

oharboe
committed
setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, (void*) &so_reuseaddr_option,
sizeof(int));
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
struct sockaddr_in sin;
unsigned int address_size;
address_size = sizeof(sin);
memset(&sin, 0, sizeof(sin));
sin.sin_family = AF_INET;
sin.sin_addr.s_addr = INADDR_ANY;
sin.sin_port = htons(5555);
if (bind(fd, (struct sockaddr *) &sin, sizeof(sin)) == -1)
{
LOG_ERROR("couldn't bind to socket: %s", strerror(errno));
exit(-1);
}
if (listen(fd, 1) == -1)
{
LOG_ERROR("couldn't listen on socket: %s", strerror(errno));
exit(-1);
}
// socket_nonblock(fd);
for (;;)
{
int session = accept(fd, (struct sockaddr *) &sin, &address_size);
if (session < 0)
{
continue;
}
setNoDelay(session, 1);
int oldopts = fcntl(session, F_GETFL, 0);
fcntl(session, F_SETFL, oldopts | O_NONBLOCK); //
int serHandle = open("/dev/ser0", O_RDWR | O_NONBLOCK);
if (serHandle < 0)
{
close(session);
continue;
}
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
653
654
655
656
657
658
659
660
661
662
663
664
665
666
667
668
669
670
671
672
int actual = 0;
int actual2 = 0;
int pos, pos2;
pos = 0;
pos2 = 0;
cur = 0;
for (;;)
{
fd_set write_fds;
fd_set read_fds;
FD_ZERO(&write_fds);
FD_ZERO(&read_fds);
int fd_max = -1;
FD_SET(session, &read_fds);
fd_max = session;
FD_SET(serHandle, &read_fds);
if (serHandle > fd_max)
{
fd_max = serHandle;
}
/* Wait... */
cyg_thread_delay(5); // 50ms fixed delay to wait for data to be sent/received
if ((actual == 0) && (actual2 == 0))
{
int retval = select(fd_max + 1, &read_fds, NULL, NULL, NULL);
if (retval <= 0)
{
break;
}
}
if (actual2 <= 0)
{
memset(backwardBuffer, 's', sizeof(backwardBuffer));

oharboe
committed
actual2 = read(serHandle, backwardBuffer,
sizeof(backwardBuffer));
if (actual2 < 0)
{
if (errno != EAGAIN)
{
goto closeSession;
}
actual2 = 0;
}
pos2 = 0;
}
int x = actual2;
int y = 0;
if (actual2 > 0)
{
int written = write(session, backwardBuffer + pos2, actual2);
if (written <= 0)
goto closeSession;
actual2 -= written;
pos2 += written;
y = written;
}

oharboe
committed
if (FD_ISSET(session, &read_fds)
&& (sizeof(forwardBuffer) > actual))
{
// NB! Here it is important that we empty the TCP/IP read buffer
// to make transmission tick right
memmove(forwardBuffer, forwardBuffer + pos, actual);
pos = 0;
int t;
// this will block if there is no data at all

oharboe
committed
t = read_socket(session, forwardBuffer + actual,
sizeof(forwardBuffer) - actual);
if (t <= 0)
{
goto closeSession;
}
actual += t;
}
int x2 = actual;
int y2 = 0;
if (actual > 0)
{
/* Do not put things into the serial buffer if it has something to send
* as that can cause a single byte to be sent at the time.
*
*
*/
int written = write(serHandle, forwardBuffer + pos, actual);
if (written < 0)
{
if (errno != EAGAIN)
{
goto closeSession;
}
// The serial buffer is full
written = 0;

oharboe
committed
}
else
{
actual -= written;
pos += written;
}
y2 = written;
}
if (cur < 1024)
{
tcpipSent[cur].req = x;
tcpipSent[cur].actual = y;
tcpipSent[cur].req2 = x2;
tcpipSent[cur].actual2 = y2;
cur++;
}
}

oharboe
committed
closeSession: close(session);
close(serHandle);
int i;
for (i = 0; i < 1024; i++)
{

oharboe
committed
diag_printf("%d %d %d %d\n", tcpipSent[i].req, tcpipSent[i].actual,
tcpipSent[i].req2, tcpipSent[i].actual2);
}
}
close(fd);
}
void startUart(void)
{

oharboe
committed
cyg_thread_create(1, zylinjtag_uart, (cyg_addrword_t) 0, "uart thread",
(void *) uart_stack, sizeof(uart_stack),
&zylinjtag_uart_thread_handle, &zylinjtag_uart_thread_object);
cyg_thread_set_priority(zylinjtag_uart_thread_handle, 1); // low priority as it sits in a busy loop
cyg_thread_resume(zylinjtag_uart_thread_handle);
}

oharboe
committed
int handle_uart_command(struct command_context_s *cmd_ctx, char *cmd,
char **args, int argc)
static int current_baud = 38400;
if (argc == 0)
{
command_print(cmd_ctx, "%d", current_baud);
return ERROR_OK;

oharboe
committed
}
else if (argc != 1)
{
return ERROR_INVALID_ARGUMENTS;
}
794
795
796
797
798
799
800
801
802
803
804
805
806
807
808
809
810
811
812
813
814
815
816
817
818
819
820
821
822
{
case 9600:
baud = CYGNUM_SERIAL_BAUD_9600;
break;
case 19200:
baud = CYGNUM_SERIAL_BAUD_19200;
break;
case 38400:
baud = CYGNUM_SERIAL_BAUD_38400;
break;
case 57600:
baud = CYGNUM_SERIAL_BAUD_57600;
break;
case 115200:
baud = CYGNUM_SERIAL_BAUD_115200;
break;
case 230400:
baud = CYGNUM_SERIAL_BAUD_230400;
break;
default:
command_print(cmd_ctx, "unsupported baudrate");
return ERROR_INVALID_ARGUMENTS;
}
cyg_serial_info_t buf;
cyg_uint32 len = 1;
//get existing serial configuration
len = sizeof(cyg_serial_info_t);
int err;
cyg_io_handle_t serial_handle;
err = cyg_io_lookup("/dev/ser0", &serial_handle);
if (err != ENOERR)
{
LOG_ERROR("/dev/ser0 not found\n");
return ERROR_FAIL;
}

oharboe
committed
err = cyg_io_get_config(serial_handle,
CYG_IO_GET_CONFIG_SERIAL_OUTPUT_DRAIN, &buf, &len);
err = cyg_io_get_config(serial_handle, CYG_IO_GET_CONFIG_SERIAL_INFO, &buf,
&len);
if (err != ENOERR)
{
command_print(cmd_ctx, "Failed to get serial port settings %d", err);
return ERROR_OK;
}
buf.baud = baud;

oharboe
committed
err = cyg_io_set_config(serial_handle, CYG_IO_SET_CONFIG_SERIAL_INFO, &buf,
&len);
if (err != ENOERR)
{
command_print(cmd_ctx, "Failed to set serial port settings %d", err);
return ERROR_OK;
}
return ERROR_OK;
}
bool logAllToSerial = false;

oharboe
committed
int boolParam(char *var);
command_context_t *setup_command_handler(void);

oharboe
committed
extern const char *zylin_config_dir;

oharboe
committed
add_script_search_dir(zylin_config_dir);
add_script_search_dir("/rom/lib/openocd");
add_script_search_dir("/rom");
return ERROR_OK;
}
int ioutil_init(struct command_context_s *cmd_ctx);
int main(int argc, char *argv[])
{
/* ramblockdevice will be the same address every time. The deflate app uses a buffer 16mBytes out, so we
* need to allocate towards the end of the heap. */
setHandler(CYGNUM_HAL_VECTOR_UNDEF_INSTRUCTION);
setHandler(CYGNUM_HAL_VECTOR_ABORT_PREFETCH);
setHandler(CYGNUM_HAL_VECTOR_ABORT_DATA);
int err;
atexit(keep_webserver);

oharboe
committed
diag_init_putc(_zylinjtag_diag_write_char);
// We want this in the log.
diag_printf("Zylin ZY1000.\n");
893
894
895
896
897
898
899
900
901
902
903
904
905
906
907
908
909
910
911
912
913
914
915
916
917
918
919
920
921
922
923
924
925
926
927
err = mount("", "/ram", "ramfs");
if (err < 0)
{
diag_printf("unable to mount ramfs\n");
}
chdir("/ram");
char address[16];
sprintf(address, "%p", &filedata[0]);
err = mount(address, "/rom", "romfs");
if (err < 0)
{
diag_printf("unable to mount /rom\n");
}
err = mount("", "/log", "logfs");
if (err < 0)
{
diag_printf("unable to mount logfs\n");
}
err = mount("", "/tftp", "tftpfs");
if (err < 0)
{
diag_printf("unable to mount logfs\n");
}
log = fopen("/log/log", "w");
if (log == NULL)
{
diag_printf("Could not open log file /ram/log\n");
exit(-1);
}
copydir("/rom", "/ram/cgi");
err = mount("/dev/flash1", "/config", "jffs2");
if (err < 0)
{
diag_printf("unable to mount jffs2, falling back to ram disk..\n");
err = mount("", "/config", "ramfs");

oharboe
committed
if (err < 0)

oharboe
committed
}
else
{
/* are we using a ram disk instead of a flash disk? This is used
* for ZY1000 live demo...
*
* copy over flash disk to ram block device
*/
if (boolParam("ramdisk"))

oharboe
committed
err = umount("/config");
if (err < 0)
{
diag_printf("unable to unmount jffs\n");
reboot();
}
err = mount("/dev/flash1", "/config2", "jffs2");
if (err < 0)
{
diag_printf("unable to mount jffs\n");
reboot();
}
if (err < 0)
{
diag_printf("unable to mount ram block device\n");
reboot();
}

oharboe
committed
// copydir("/config2", "/config");
copyfile("/config2/ip", "/config/ip");
copydir("/config2/settings", "/config/settings");
umount("/config2");
}

oharboe
committed
mkdir(zylin_config_dir, 0777);
char *dirname=alloc_printf("%s/target", zylin_config_dir);
mkdir(dirname, 0777);
free(dirname);
dirname=alloc_printf("%s/board", zylin_config_dir);
mkdir(dirname, 0777);

oharboe
committed
free(dirname);
dirname=alloc_printf("%s/event", zylin_config_dir);
mkdir(dirname, 0777);
free(dirname);
logAllToSerial = boolParam("logserial");
// We need the network & web server in case there is something wrong with
// the config files that invoke exit()
zylinjtag_startNetwork();
/* we're going to access the jim interpreter from here on... */
openocd_sleep_postlude();
startUart();
add_default_dirs();
/* initialize commandline interface */

oharboe
committed
command_context_t * cmd_ctx;
cmd_ctx = setup_command_handler();
command_set_output_handler(cmd_ctx, configuration_output_handler, NULL);
command_context_mode(cmd_ctx, COMMAND_CONFIG);
#if BUILD_IOUTIL
if (ioutil_init(cmd_ctx) != ERROR_OK)
{
return EXIT_FAILURE;
}
#endif
#ifdef CYGPKG_PROFILE_GPROF
register_command(cmd_ctx, NULL, "ecosboard_profile", eCosBoard_handle_eCosBoard_profile_command,
COMMAND_ANY, NULL);
#endif

oharboe
committed
register_command(cmd_ctx, NULL, "uart", handle_uart_command, COMMAND_ANY,
"uart <baud> - forward uart on port 5555");
int errVal;
errVal = log_init(cmd_ctx);
if (errVal != ERROR_OK)
{
diag_printf("log_init() failed %d\n", errVal);
exit(-1);
}
set_log_output(cmd_ctx, log);
LOG_DEBUG("log init complete");
// diag_printf("Executing config files\n");
if (logAllToSerial)
{

oharboe
committed
diag_printf(
"%s/logserial=1 => sending log output to serial port using \"debug_level 3\" as default.\n", zylin_config_dir);
command_run_line(cmd_ctx, "debug_level 3");
}

oharboe
committed
command_run_linef(cmd_ctx, "script /rom/openocd.cfg");
// FIX!!! Yuk!
// diag_printf() is really invoked from many more places than we trust it
// not to cause instabilities(e.g. invoking fputc() from an interrupt is *BAD*).
//
// Disabling it here is safe and gives us enough logged debug output for now. Crossing
// fingers that it doesn't cause any crashes.
diag_printf("Init complete, GDB & telnet servers launched.\n");

oharboe
committed
command_set_output_handler(cmd_ctx,
zy1000_configuration_output_handler_log, NULL);
if (!logAllToSerial)
{
serialLog = false;
}
/* handle network connections */
server_loop(cmd_ctx);
openocd_sleep_prelude();
/* shut server down */
server_quit();
/* free commandline interface */
command_done(cmd_ctx);
umount("/config");
exit(0);

oharboe
committed
for (;;)
;

oharboe
committed
cyg_int32 cyg_httpd_exec_cgi_tcl(char *file_name);
1079
1080
1081
1082
1083
1084
1085
1086
1087
1088
1089
1090
1091
1092
1093
1094
1095
1096
1097
1098
1099
1100
1101
1102
1103
1104
1105
1106
1107
1108
1109
1110
1111
1112
1113
1114
1115
1116
1117
1118
1119
1120
1121
1122
1123
1124
1125
1126
1127
1128
1129
1130
1131
1132
1133
1134
1135
1136
1137
1138
1139
1140
1141
1142
1143
1144
1145
1146
1147
1148
1149
1150
1151
1152
1153
1154
1155
1156
1157
1158
1159
1160
1161
1162
1163
1164
1165
1166
1167
1168
1169
1170
1171
1172
1173
1174
1175
1176
1177
1178
1179
cyg_int32 homeForm(CYG_HTTPD_STATE *p)
{
cyg_httpd_exec_cgi_tcl("/ram/cgi/index.tcl");
return 0;
}
CYG_HTTPD_HANDLER_TABLE_ENTRY(root_label, "/", homeForm);
CYG_HTTPD_MIME_TABLE_ENTRY(text_mime_label, "text", "text/plain");
CYG_HTTPD_MIME_TABLE_ENTRY(bin_mime_label, "bin", "application/octet-stream");
#include <pkgconf/system.h>
#include <pkgconf/hal.h>
#include <pkgconf/kernel.h>
#include <pkgconf/io_fileio.h>
#include <pkgconf/fs_rom.h>
#include <cyg/kernel/ktypes.h> // base kernel types
#include <cyg/infra/cyg_trac.h> // tracing macros
#include <cyg/infra/cyg_ass.h> // assertion macros
#include <unistd.h>
#include <sys/types.h>
#include <fcntl.h>
#include <sys/stat.h>
#include <errno.h>
#include <dirent.h>
#include <stdarg.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <cyg/fileio/fileio.h>
#include <cyg/kernel/kapi.h>
#include <cyg/infra/diag.h>
//==========================================================================
// Eventually we want to eXecute In Place from the ROM in a protected
// environment, so we'll need executables to be aligned to a boundary
// suitable for MMU protection. A suitable boundary would be the 4k
// boundary in all the CPU architectures I am currently aware of.
// Forward definitions
// Filesystem operations
static int tftpfs_mount(cyg_fstab_entry *fste, cyg_mtab_entry *mte);
static int tftpfs_umount(cyg_mtab_entry *mte);
static int tftpfs_open(cyg_mtab_entry *mte, cyg_dir dir, const char *name,
int mode, cyg_file *fte);
static int tftpfs_fo_read(struct CYG_FILE_TAG *fp, struct CYG_UIO_TAG *uio);
static int tftpfs_fo_write(struct CYG_FILE_TAG *fp, struct CYG_UIO_TAG *uio);
// File operations
static int tftpfs_fo_fsync(struct CYG_FILE_TAG *fp, int mode);
static int tftpfs_fo_close(struct CYG_FILE_TAG *fp);
static int tftpfs_fo_lseek(struct CYG_FILE_TAG *fp, off_t *apos, int whence);
//==========================================================================
// Filesystem table entries
// -------------------------------------------------------------------------
// Fstab entry.
// This defines the entry in the filesystem table.
// For simplicity we use _FILESYSTEM synchronization for all accesses since
// we should never block in any filesystem operations.
#if 1
FSTAB_ENTRY( tftpfs_fste, "tftpfs", 0,
CYG_SYNCMODE_NONE,
tftpfs_mount,
tftpfs_umount,
tftpfs_open,
(cyg_fsop_unlink *)cyg_fileio_erofs,
(cyg_fsop_mkdir *)cyg_fileio_erofs,
(cyg_fsop_rmdir *)cyg_fileio_erofs,
(cyg_fsop_rename *)cyg_fileio_erofs,
(cyg_fsop_link *)cyg_fileio_erofs,
(cyg_fsop_opendir *)cyg_fileio_erofs,
(cyg_fsop_chdir *)cyg_fileio_erofs,
(cyg_fsop_stat *)cyg_fileio_erofs,
(cyg_fsop_getinfo *)cyg_fileio_erofs,
(cyg_fsop_setinfo *)cyg_fileio_erofs);
#endif
// -------------------------------------------------------------------------
// mtab entry.
// This defines a single ROMFS loaded into ROM at the configured address
//
// MTAB_ENTRY( rom_mte, // structure name
// "/rom", // mount point
// "romfs", // FIlesystem type
// "", // hardware device
// (CYG_ADDRWORD) CYGNUM_FS_ROM_BASE_ADDRESS // Address in ROM
// );
// -------------------------------------------------------------------------
// File operations.
// This set of file operations are used for normal open files.
static cyg_fileops tftpfs_fileops =

oharboe
committed
{ tftpfs_fo_read, tftpfs_fo_write, tftpfs_fo_lseek,
(cyg_fileop_ioctl *) cyg_fileio_erofs, cyg_fileio_seltrue,
tftpfs_fo_fsync, tftpfs_fo_close,
(cyg_fileop_fstat *) cyg_fileio_erofs,
(cyg_fileop_getinfo *) cyg_fileio_erofs,

oharboe
committed
(cyg_fileop_setinfo *) cyg_fileio_erofs, };
1186
1187
1188
1189
1190
1191
1192
1193
1194
1195
1196
1197
1198
1199
1200
1201
1202
1203
1204
1205
1206
1207
1208
1209
1210
1211
1212
1213
1214
1215
1216
1217
1218
1219
1220
1221
1222
1223
1224
1225
1226
1227
1228
1229
1230
1231
1232
1233
1234
1235
1236
1237
1238
1239
1240
1241
1242
1243
1244
1245
1246
1247
1248
1249
1250
1251
1252
1253
1254
1255
1256
1257
1258
1259
1260
1261
1262
1263
1264
1265
1266
1267
1268
1269
1270
1271
1272
1273
1274
1275
1276
1277
1278
1279
1280
1281
// -------------------------------------------------------------------------
// tftpfs_mount()
// Process a mount request. This mainly finds root for the
// filesystem.
static int tftpfs_mount(cyg_fstab_entry *fste, cyg_mtab_entry *mte)
{
return ENOERR;
}
static int tftpfs_umount(cyg_mtab_entry *mte)
{
return ENOERR;
}
struct Tftp
{
int write;
int readFile;
cyg_uint8 *mem;
int actual;
char *server;
char *file;
};
static void freeTftp(struct Tftp *t)
{
if (t == NULL)
return;
if (t->mem)
free(t->mem);
if (t->server)
free(t->server);
if (t->file)
free(t->file);
free(t);
}
static const int tftpMaxSize = 8192 * 1024;
static int tftpfs_open(cyg_mtab_entry *mte, cyg_dir dir, const char *name,
int mode, cyg_file *file)
{
struct Tftp *tftp;
tftp = malloc(sizeof(struct Tftp));
if (tftp == NULL)
return EMFILE;
memset(tftp, 0, sizeof(struct Tftp));
file->f_flag |= mode & CYG_FILE_MODE_MASK;
file->f_type = CYG_FILE_TYPE_FILE;
file->f_ops = &tftpfs_fileops;
file->f_offset = 0;
file->f_data = 0;
file->f_xops = 0;
tftp->mem = malloc(tftpMaxSize);
if (tftp->mem == NULL)
{
freeTftp(tftp);
return EMFILE;
}
char *server = strchr(name, '/');
if (server == NULL)
{
freeTftp(tftp);
return EMFILE;
}
tftp->server = malloc(server - name + 1);
if (tftp->server == NULL)
{
freeTftp(tftp);
return EMFILE;
}
strncpy(tftp->server, name, server - name);
tftp->server[server - name] = 0;
tftp->file = strdup(server + 1);
if (tftp->file == NULL)
{
freeTftp(tftp);
return EMFILE;
}
file->f_data = (CYG_ADDRWORD) tftp;
return ENOERR;
}
static int fetchTftp(struct Tftp *tftp)
{
if (!tftp->readFile)
{
int err;

oharboe
committed
tftp->actual = tftp_client_get(tftp->file, tftp->server, 0, tftp->mem,
tftpMaxSize, TFTP_OCTET, &err);
if (tftp->actual < 0)
{
return EMFILE;
}
tftp->readFile = 1;
}
return ENOERR;
}
// -------------------------------------------------------------------------
// tftpfs_fo_write()
// Read data from file.

oharboe
committed
static int tftpfs_fo_read(struct CYG_FILE_TAG *fp, struct CYG_UIO_TAG *uio)
1299
1300
1301
1302
1303
1304
1305
1306
1307
1308
1309
1310
1311
1312
1313
1314
1315
1316
1317
1318
1319
1320
1321
1322
1323
1324
1325
1326
1327
1328
1329
{
struct Tftp *tftp = (struct Tftp *) fp->f_data;
if (fetchTftp(tftp) != ENOERR)
return EMFILE;
int i;
off_t pos = fp->f_offset;
int resid = 0;
for (i = 0; i < uio->uio_iovcnt; i++)
{
cyg_iovec *iov = &uio->uio_iov[i];
char *buf = (char *) iov->iov_base;
off_t len = iov->iov_len;
if (len + pos > tftp->actual)
{
len = tftp->actual - pos;
}
resid += iov->iov_len - len;
memcpy(buf, tftp->mem + pos, len);
pos += len;
}
uio->uio_resid = resid;
fp->f_offset = pos;
return ENOERR;
}

oharboe
committed
static int tftpfs_fo_write(struct CYG_FILE_TAG *fp, struct CYG_UIO_TAG *uio)
1331
1332
1333
1334
1335
1336
1337
1338
1339
1340
1341
1342
1343
1344
1345
1346
1347
1348
1349
1350
1351
1352
1353
1354
1355
1356
1357
1358
1359
1360
{
struct Tftp *tftp = (struct Tftp *) fp->f_data;
int i;
off_t pos = fp->f_offset;
int resid = 0;
for (i = 0; i < uio->uio_iovcnt; i++)
{
cyg_iovec *iov = &uio->uio_iov[i];
char *buf = (char *) iov->iov_base;
off_t len = iov->iov_len;
if (len + pos > tftpMaxSize)
{
len = tftpMaxSize - pos;
}
resid += iov->iov_len - len;
memcpy(tftp->mem + pos, buf, len);
pos += len;
}
uio->uio_resid = resid;
fp->f_offset = pos;
tftp->write = 1;
return ENOERR;
}

oharboe
committed
static int tftpfs_fo_fsync(struct CYG_FILE_TAG *fp, int mode)
{
int error = ENOERR;
return error;
}
// -------------------------------------------------------------------------
// romfs_fo_close()
// Close a file. We just clear out the data pointer.
static int tftpfs_fo_close(struct CYG_FILE_TAG *fp)
{
struct Tftp *tftp = (struct Tftp *) fp->f_data;
int error = ENOERR;
if (tftp->write)
{

oharboe
committed
tftp_client_put(tftp->file, tftp->server, 0, tftp->mem, fp->f_offset,
TFTP_OCTET, &error);
1380
1381
1382
1383
1384
1385
1386
1387
1388
1389
1390
1391
1392
1393
1394
1395
1396
1397
1398
1399
1400
1401
1402
1403
1404
1405
1406
1407
1408
1409
1410
1411
1412
1413
1414
1415
1416
1417
1418
1419
1420
1421
1422
1423
1424
1425
1426
1427
1428
1429
1430
1431
1432
1433
1434
1435
1436
1437
1438
}
freeTftp(tftp);
fp->f_data = 0;
return error;
}
// -------------------------------------------------------------------------
// romfs_fo_lseek()
// Seek to a new file position.
static int tftpfs_fo_lseek(struct CYG_FILE_TAG *fp, off_t *apos, int whence)
{
struct Tftp *tftp = (struct Tftp *) fp->f_data;
off_t pos = *apos;
if (fetchTftp(tftp) != ENOERR)
return EMFILE;
switch (whence)
{
case SEEK_SET:
// Pos is already where we want to be.
break;
case SEEK_CUR:
// Add pos to current offset.
pos += fp->f_offset;
break;
case SEEK_END:
// Add pos to file size.
pos += tftp->actual;
break;
default:
return EINVAL;
}
// Check that pos is still within current file size, or at the
// very end.
if (pos < 0 || pos > tftp->actual)
return EINVAL;
// All OK, set fp offset and return new position.
*apos = fp->f_offset = pos;
return ENOERR;
}
void usleep(int us)
{
if (us > 10000)
cyg_thread_delay(us / 10000 + 1);
else
HAL_DELAY_US(us);
}
// Chunked version.

oharboe
committed
cyg_int32 show_log_entry(CYG_HTTPD_STATE *phttpstate)
{
cyg_httpd_start_chunked("text");
if (logCount >= logSize)
{

oharboe
committed
cyg_httpd_write_chunked(logBuffer + logCount % logSize, logSize
- logCount % logSize);
}
cyg_httpd_write_chunked(logBuffer, writePtr);
cyg_httpd_end_chunked();
return -1;
}
CYG_HTTPD_HANDLER_TABLE_ENTRY(show_log, "/ram/log", show_log_entry);
// Filesystem operations
static int logfs_mount(cyg_fstab_entry *fste, cyg_mtab_entry *mte);
static int logfs_umount(cyg_mtab_entry *mte);
static int logfs_open(cyg_mtab_entry *mte, cyg_dir dir, const char *name,
int mode, cyg_file *fte);

oharboe
committed
static int logfs_fo_write(struct CYG_FILE_TAG *fp, struct CYG_UIO_TAG *uio);
// File operations
static int logfs_fo_fsync(struct CYG_FILE_TAG *fp, int mode);
static int logfs_fo_close(struct CYG_FILE_TAG *fp);
#include <cyg/io/devtab.h>
1467
1468
1469
1470
1471
1472
1473
1474
1475
1476
1477
1478
1479
1480
1481
1482
1483
1484
1485
1486
1487
1488
1489
1490
1491
1492
1493
1494
1495
//==========================================================================
// Filesystem table entries
// -------------------------------------------------------------------------
// Fstab entry.
// This defines the entry in the filesystem table.
// For simplicity we use _FILESYSTEM synchronization for all accesses since
// we should never block in any filesystem operations.
FSTAB_ENTRY( logfs_fste, "logfs", 0,
CYG_SYNCMODE_FILE_FILESYSTEM|CYG_SYNCMODE_IO_FILESYSTEM,
logfs_mount,
logfs_umount,
logfs_open,
(cyg_fsop_unlink *)cyg_fileio_erofs,
(cyg_fsop_mkdir *)cyg_fileio_erofs,
(cyg_fsop_rmdir *)cyg_fileio_erofs,
(cyg_fsop_rename *)cyg_fileio_erofs,
(cyg_fsop_link *)cyg_fileio_erofs,
(cyg_fsop_opendir *)cyg_fileio_erofs,
(cyg_fsop_chdir *)cyg_fileio_erofs,
(cyg_fsop_stat *)cyg_fileio_erofs,
(cyg_fsop_getinfo *)cyg_fileio_erofs,
(cyg_fsop_setinfo *)cyg_fileio_erofs);
// -------------------------------------------------------------------------
// File operations.
// This set of file operations are used for normal open files.
static cyg_fileops logfs_fileops =

oharboe
committed
{ (cyg_fileop_read *) cyg_fileio_erofs, (cyg_fileop_write *) logfs_fo_write,
(cyg_fileop_lseek *) cyg_fileio_erofs,

oharboe
committed
(cyg_fileop_ioctl *) cyg_fileio_erofs, cyg_fileio_seltrue,
logfs_fo_fsync, logfs_fo_close, (cyg_fileop_fstat *) cyg_fileio_erofs,
(cyg_fileop_getinfo *) cyg_fileio_erofs,

oharboe
committed
(cyg_fileop_setinfo *) cyg_fileio_erofs, };
1502
1503
1504
1505
1506
1507
1508
1509
1510
1511
1512
1513
1514
1515
1516
1517
1518
1519
1520
1521
1522
1523
1524
1525
1526
1527
1528
1529
1530
1531
1532
1533
// -------------------------------------------------------------------------
// logfs_mount()
// Process a mount request. This mainly finds root for the
// filesystem.
static int logfs_mount(cyg_fstab_entry *fste, cyg_mtab_entry *mte)
{
return ENOERR;
}
static int logfs_umount(cyg_mtab_entry *mte)
{
return ENOERR;
}
static int logfs_open(cyg_mtab_entry *mte, cyg_dir dir, const char *name,
int mode, cyg_file *file)
{
file->f_flag |= mode & CYG_FILE_MODE_MASK;
file->f_type = CYG_FILE_TYPE_FILE;
file->f_ops = &logfs_fileops;
file->f_offset = 0;
file->f_data = 0;
file->f_xops = 0;
return ENOERR;
}
// -------------------------------------------------------------------------
// logfs_fo_write()
// Write data to file.

oharboe
committed
static int logfs_fo_write(struct CYG_FILE_TAG *fp, struct CYG_UIO_TAG *uio)
{
int i;
for (i = 0; i < uio->uio_iovcnt; i++)
{
cyg_iovec *iov = &uio->uio_iov[i];
char *buf = (char *) iov->iov_base;
off_t len = iov->iov_len;
diag_write(buf, len);
}
uio->uio_resid = 0;
return ENOERR;
}

oharboe
committed
static int logfs_fo_fsync(struct CYG_FILE_TAG *fp, int mode)
{
return ENOERR;
}
// -------------------------------------------------------------------------
// romfs_fo_close()
// Close a file. We just clear out the data pointer.
static int logfs_fo_close(struct CYG_FILE_TAG *fp)
{
return ENOERR;
}