packages/net/ftpclient/v2_0/tests/ftp_var_example.c

   1 #include <pkgconf/system.h>
   2 #define _config_OK
   3 #if !defined(CYGPKG_NET_FTPCLIENT)
   4 #error "Configuration is missing: CYGPKG_NET_FTPCLIENT"
   5 #undef _config_OK
   6 #endif
   7 #if !defined(CYGPKG_COMPRESS_ZLIB)
   8 #error "Configuration is missing: CYGPKG_COMPRESS_ZLIB"
   9 #undef _config_OK
  10 #else
  11 #include <pkgconf/compress_zlib.h>
  12 #if !defined(CYGSEM_COMPRESS_ZLIB_DEFLATE_MAKES_GZIP)
  13 #error "Configuration is missing: CYGSEM_COMPRESS_ZLIB_DEFLATE_MAKES_GZIP"
  14 #undef _config_OK
  15 #endif
  16 #endif
  17 #if !defined(CYGPKG_CRC)
  18 #error "Configuration is missing: CYGPKG_CRC"
  19 #undef _config_OK
  20 #endif
  21
  22 #ifdef _config_OK
  23 #include <stdio.h>
  24 #include <stdlib.h>
  25 #include <ftpclient.h>
  26 #include <cyg/compress/zlib.h>
  27
  28 #include <pkgconf/net.h>
  29 #include <sys/param.h>
  30 #include <sys/socket.h>
  31 #include <sys/ioctl.h>
  32 #include <sys/errno.h>
  33
  34 #include <net/if.h>
  35 #include <netinet/in.h>
  36 #include <netinet/ip.h>
  37 #include <netinet/ip_icmp.h>
  38 #include <net/route.h>
  39
  40 #include <cyg/infra/diag.h>
  41 #include <cyg/kernel/kapi.h>
  42
  43 #include <bootp.h>
  44 #include <network.h>
  45 #include <arpa/inet.h>
  46
  47 #include "nvram.h"
  48 #include "lkvm.h"
  49 #include "getopt.h"
  50
  51 #define MAX_ARGV 32
  52
  53 #ifdef CYGHWR_NET_DRIVER_ETH0
  54 static struct bootp eth0_bootp_data;
  55 static const char  *eth0_name = "eth0";
  56 #endif
  57 #ifdef CYGHWR_NET_DRIVER_ETH1
  58 static struct bootp eth1_bootp_data;
  59 static const char  *eth1_name = "eth1";
  60 #endif
  61
  62 // TEMP for debug
  63 core_info_t test_core_info = {
  64     .fence0 = KCORE_FENCE0_PAT,
  65     .fence1 = KCORE_FENCE1_PAT,
  66     .fence2 = KCORE_FENCE2_PAT,
  67     .fence3 = KCORE_FENCE3_PAT,
  68     .crash = KCORE_CRASH_PANIC,
  69     .panicstr = "This is a panic string",
  70     .ncpu = 1,
  71     .nsegs = 2,
  72     .physical_banks[0] = { 0x700000, 0x40000 },
  73     .physical_banks[1] = { 0x740000, 0x40000 },
  74     .sr[0] = 0xB00B0000,
  75     .sr[1] = 0xB00B0001,
  76     .sr[2] = 0xB00B0002,
  77     .sr[3] = 0xB00B0003,
  78     .sr[4] = 0xB00B0004,
  79     .sr[5] = 0xB00B0005,
  80     .sr[6] = 0xB00B0006,
  81     .sr[7] = 0xB00B0007,
  82     .dbatl[0] = 0xDEAD0000, .dbatu[0] = 0xDEAD1000,
  83     .dbatl[1] = 0xDEAD0001, .dbatu[1] = 0xDEAD1001,
  84     .dbatl[2] = 0xDEAD0002, .dbatu[2] = 0xDEAD1002,
  85     .dbatl[3] = 0xDEAD0003, .dbatu[3] = 0xDEAD1003,
  86     .dbatl[4] = 0xDEAD0004, .dbatu[4] = 0xDEAD1004,
  87     .dbatl[5] = 0xDEAD0005, .dbatu[5] = 0xDEAD1005,
  88     .dbatl[6] = 0xDEAD0006, .dbatu[6] = 0xDEAD1006,
  89     .dbatl[7] = 0xDEAD2007, .dbatu[7] = 0xDEAD3007,
  90     .ibatl[0] = 0xDEAD2000, .ibatu[0] = 0xDEAD3000,
  91     .ibatl[1] = 0xDEAD2001, .ibatu[1] = 0xDEAD3001,
  92     .ibatl[2] = 0xDEAD2002, .ibatu[2] = 0xDEAD3002,
  93     .ibatl[3] = 0xDEAD2003, .ibatu[3] = 0xDEAD3003,
  94     .ibatl[4] = 0xDEAD2004, .ibatu[4] = 0xDEAD3004,
  95     .ibatl[5] = 0xDEAD2005, .ibatu[5] = 0xDEAD3005,
  96     .ibatl[6] = 0xDEAD2006, .ibatu[6] = 0xDEAD3006,
  97     .ibatl[7] = 0xDEAD2007, .ibatu[7] = 0xDEAD3007,
  98 };
  99 // TEMP
 100
 101 #define FTP_BUFSIZE 4096
 102 struct ftp_data {
 103     z_stream stream;
 104     char     buf[FTP_BUFSIZE], *bufp;
 105     int      len;
 106     int      src_len;
 107     int      first;
 108     int    (*get_data)(char **ptr, void *param);
 109     void    *get_param;
 110 };
 111
 112 int _ftp_write_gz(char *buf, int len, void *priv)
 113 {
 114     struct ftp_data *dp = (struct ftp_data *)priv;
 115     int err;
 116     int res = 0;
 117     char *src;
 118
 119     if (dp->first) {
 120         // Ugly hack - zlib needs a value for 'avail_in' at initialization
 121         // time, even though we don't have anything ready yet
 122         dp->stream.avail_in = 0;
 123         dp->first = 0;
 124     }
 125     while ((dp->len == 0) && (dp->src_len > 0)) {
 126         // Has input buffer been exhausted?
 127         if (dp->stream.avail_in == 0) {
 128             dp->src_len = (*dp->get_data)(&src, dp->get_param);
 129             dp->stream.next_in = src;
 130             dp->stream.avail_in = dp->src_len;
 131         }
 132         // See if more data is available to be compressed
 133         dp->stream.avail_out = FTP_BUFSIZE;
 134         dp->stream.next_out = dp->buf;
 135         err = deflate(&dp->stream, dp->src_len ? Z_NO_FLUSH : Z_FINISH);
 136         dp->len = FTP_BUFSIZE - dp->stream.avail_out;
 137         dp->bufp = dp->buf;
 138     }
 139     // Move up to 'len' bytes from internal buffer
 140     res = len;
 141     if (res > dp->len) {
 142         res = dp->len;
 143     }
 144     memcpy(buf, dp->bufp, res);
 145     dp->bufp += res;
 146     dp->len -= res;
 147     return res;
 148 }
 149
 150 struct _simple_get_data_param {
 151     char *ptr;
 152     int   len;
 153 };
 154
 155 int
 156 simple_get_data(char **ptr, void *param)
 157 {
 158     struct _simple_get_data_param *gp = (struct _simple_get_data_param *)param;
 159     int res;
 160
 161     *ptr = gp->ptr;
 162     res = gp->len;
 163     gp->len = 0;
 164     return res;
 165
 166 }
 167
 168
 169 //
 170 // Parse (scan/copy) network addresses.  If the IP address contains
 171 // a '/', then use that to determine the netmask and ignore the
 172 // specified value.
 173 //
 174 bool
 175 parse_eth_addrs(char *desired_ip, char *desired_netmask,
 176                 char *ip, char *netmask, char *broadcast)
 177 {
 178     char *src, *dst;
 179     bool found_netmask = false;
 180     int mask_size, mask, ip_addr;
 181
 182 //    diag_printf("parse - ip: '%s', mask: '%s'\n", desired_ip, desired_netmask);
 183     // IP address
 184     src = desired_ip;  dst = ip;
 185     while (*src) {
 186         if (*src == '/') {
 187             // Do something with netmask
 188             src++;
 189             found_netmask = true;
 190             mask_size = 0;
 191             while (*src) {
 192                 mask_size = (mask_size * 10) + (*src++ - '0');
 193             }
 194             mask = 0xFFFFFFFF << (32-mask_size);
 195             break;
 196         }
 197         *dst++ = *src++;
 198     }
 199     *dst = '\0';
 200     if (!found_netmask) {
 201         if (!inet_aton(desired_netmask, (struct in_addr *)&mask)) {
 202             diag_printf("Error: Invalid netmask '%s'\n", desired_netmask);
 203             return false;  // Illegal netmask
 204         }
 205     }
 206     strcpy(netmask, inet_ntoa(*(struct in_addr *)&mask));
 207     if (!inet_aton(ip, (struct in_addr *)&ip_addr)) {
 208         diag_printf("Error: Invalid IP address '%s'\n", ip);
 209         return false;
 210     }
 211     ip_addr = (ip_addr & mask) | ~mask;
 212     strcpy(broadcast, inet_ntoa(*(struct in_addr *)&ip_addr));
 213 //    diag_printf("ip: '%s', netmask: '%s', broadcast: '%s'\n", ip, netmask, broadcast);
 214     return true;
 215 }
 216
 217 struct core_dump_param {
 218     int             phase;
 219     int             segno;
 220     core_info_t    *cp;
 221     kcore_hdr_t     hdr;
 222     kcore_seg_t     cpu_hdr, ram_hdr;
 223     cpu_kcore_hdr_t cpu_info;
 224     phys_ram_seg_t  cpu_phys_segs[8];
 225 };
 226
 227 #define ALIGN(v,n) ((((v)+((n)-1))/(n))*(n))
 228
 229 int
 230 dump_core(char **ptr, void *param)
 231 {
 232     struct core_dump_param *dp = (struct core_dump_param *)param;
 233     int len;
 234
 235     switch (dp->phase) {
 236     case 0:
 237         // File header (kcore_hdr_t)
 238         dp->phase = 1;
 239         *ptr = (char *)&dp->hdr;
 240         return ALIGN(sizeof(dp->hdr), 8);
 241     case 1:
 242         // CPU header (kcore_seg_t)
 243         dp->phase = 2;
 244         *ptr = (char *)&dp->cpu_hdr;
 245         return ALIGN(sizeof(dp->cpu_hdr), 8);
 246     case 2:
 247         // CPU info (cpu_kcore_hdr_t)
 248         dp->phase = 3;
 249         dp->segno = 0;
 250         *ptr = (char *)&dp->cpu_info;
 251         return sizeof(dp->cpu_info);
 252     case 3:
 253         // Physical RAM segment descriptions (phys_ram_seg_t)
 254         *ptr = (char *)&dp->cpu_phys_segs[dp->segno];
 255         if (++dp->segno == dp->cp->nsegs) {
 256             dp->phase = 4;
 257         }
 258         return sizeof(dp->cpu_phys_segs[0]);
 259     case 4:
 260         // RAM header (kcore_seg_t)
 261         dp->phase = 5;
 262         *ptr = (char *)&dp->ram_hdr;
 263         dp->segno = 0;
 264         return ALIGN(sizeof(dp->ram_hdr), 8);
 265     case 5:
 266         // RAM segment
 267         *ptr = (char *)dp->cpu_phys_segs[dp->segno].start;
 268         len = dp->cpu_phys_segs[dp->segno].size;
 269         if (++dp->segno == dp->cp->nsegs) {
 270             dp->phase = 6;
 271         }
 272         return len;
 273     case 6:
 274         // All done!
 275         return 0;
 276     default:
 277         diag_printf("Bad core dump phase: %d\n", dp->phase);
 278         return 0;
 279     }
 280 }
 281
 282 void
 283 expand_file_name(char *file_name, char *path, char *ip)
 284 {
 285     char *fn = nvram_get("dump_name");
 286     char *dp = file_name;
 287     char last = '\0';
 288
 289     if (!fn) fn = "XPathOS.%i.core.gz";
 290     if (!path) path = "/";
 291     while (*path) {
 292         last = *path++;
 293         *dp++ = last;
 294     }
 295     if (last != '/') {
 296         *dp++ = '/';
 297     }
 298     while (*fn) {
 299         if (*fn == '%') {
 300             fn += 2;  // Skip '%i'
 301             while (*ip) {
 302                 *dp++ = *ip++;
 303             }
 304         } else {
 305             *dp++ = *fn++;
 306         }
 307     }
 308     *dp = '\0';
 309 }
 310
 311 void
 312 do_core_dump(core_info_t *cp, char *ip)
 313 {
 314     struct core_dump_param cd;
 315     // Caution - this can't be on the stack unless you increase the stack size!
 316     static struct ftp_data dp;
 317     int err, wlen, i;
 318     unsigned long total_ram_size;
 319     char file_name[256];
 320     char *dump_ip, *dump_user, *dump_pass;
 321
 322     dump_ip = nvram_get("dump_server");
 323     if (!dump_ip) {
 324         diag_printf("Can't dump: server IP missing in NVRAM\n");
 325         return;
 326     }
 327     dump_user = nvram_get("dump_user");
 328     if (!dump_user) {
 329         diag_printf("Can't dump: user name missing in NVRAM\n");
 330         return;
 331     }
 332     dump_pass = nvram_get("dump_pass");
 333     if (!dump_pass) {
 334         diag_printf("Can't dump: password missing in NVRAM\n");
 335         return;
 336     }
 337     expand_file_name(file_name, nvram_get("dump_path"), ip);
 338
 339     // Fill in core dump structures
 340     cd.hdr.c_midmag = KCORE_HDR_MAGIC;
 341     cd.hdr.c_hdrsize = ALIGN(sizeof(cd.hdr), 8);
 342     cd.hdr.c_seghdrsize = ALIGN(sizeof(cd.cpu_hdr), 8);
 343     cd.hdr.c_nseg = cp->nsegs;
 344
 345     cd.cpu_hdr.c_midmag = KCORE_CPU_SEGMENT;
 346     cd.cpu_hdr.c_size = sizeof(kcore_seg_t)+sizeof(cpu_kcore_hdr_t)+(cp->nsegs*sizeof(phys_ram_seg_t));
 347     // Copy info from core-dump area
 348     cd.cpu_info.pvr = cp->pvr;
 349     cd.cpu_info.sdr1 = cp->sdr1;
 350     for (i = 0;  i < 8;  i++) {
 351         cd.cpu_info.sr[i] = cp->sr[i];
 352         cd.cpu_info.dbatl[i] = cp->dbatl[i];
 353         cd.cpu_info.dbatu[i] = cp->dbatu[i];
 354         cd.cpu_info.ibatl[i] = cp->ibatl[i];
 355         cd.cpu_info.ibatu[i] = cp->ibatu[i];
 356     }
 357     for (i = 0;  i < 8;  i++) {
 358         cd.cpu_phys_segs[i].start = cp->physical_banks[i].base;
 359         cd.cpu_phys_segs[i].size = cp->physical_banks[i].length;
 360     }
 361
 362     total_ram_size = 0;
 363     cd.ram_hdr.c_midmag = KCORE_DATA_SEGMENT;
 364     cd.ram_hdr.c_size = sizeof(kcore_seg_t)+total_ram_size;
 365
 366     cd.phase = 0;
 367     cd.cp = cp;
 368
 369     dp.len = 0;
 370     dp.get_data = dump_core;
 371     dp.get_param = &cd;
 372     dp.src_len = 1;
 373     dp.first = 1;
 374     dp.stream.next_in = 0;
 375     dp.stream.avail_in = 0x1000;
 376     dp.stream.next_out = dp.buf;
 377     dp.stream.avail_out = FTP_BUFSIZE;
 378     dp.stream.zalloc = (alloc_func)0;
 379     dp.stream.zfree = (free_func)0;
 380     dp.stream.opaque = (voidpf)0;
 381
 382     err = deflateInit(&dp.stream, Z_DEFAULT_COMPRESSION);
 383     diag_printf("err = %d\n", err);
 384
 385     diag_printf("... dumping core as %s\n", file_name);
 386
 387     wlen = ftp_put_var(dump_ip, dump_user, dump_pass, file_name,
 388                        _ftp_write_gz, &dp, ftpclient_printf);
 389     diag_printf("res = %d\n", wlen);
 390     deflateEnd(&dp.stream);
 391 }
 392
 393 void
 394 scan_args(char *cmdline, int *argc, char **argv, char **alt_cmdline)
 395 {
 396     char *cp = cmdline;
 397     int indx = 0;
 398
 399     argv[indx++] = "secondary-load";
 400     *alt_cmdline = (char *)0;
 401     while (*cp) {
 402         // Skip over any white space
 403         while (*cp && (*cp == ' ')) cp++;
 404         if (!*cp) break;
 405         // Check for -- break
 406         if ((cp[0] == '-') && (cp[1] == '-')) {
 407             // End of normal list
 408             cp += 2;
 409             while (*cp && (*cp == ' ')) cp++;
 410             *alt_cmdline = cp;
 411             *argc = indx;
 412             return;
 413         }
 414         // Split argument
 415         argv[indx++] = cp;
 416         while (*cp) {
 417             if (*cp == ' ') {
 418                 *cp++ = '\0';
 419                 break;
 420             }
 421             cp++;
 422         }
 423     }
 424     *argc = indx;
 425 }
 426
 427 int
 428 loader_main(char *cmdline)
 429 {
 430     int len, wlen;
 431     int err;
 432     int argc, i;
 433     char *argv[MAX_ARGV], *alt_cmdline;
 434     bool force_dump = false;
 435     bool quick_boot = false;
 436     bool verbose = false;
 437     char *boot_info = (char *)NULL;
 438     // Caution - this can't be on the stack unless you increase the stack size!
 439     static struct ftp_data dp;
 440     struct _simple_get_data_param gp;
 441 #ifdef CYGHWR_NET_DRIVER_ETH0
 442     char eth0_ip[32], eth0_netmask[32], eth0_broadcast[32];
 443 #endif
 444 #ifdef CYGHWR_NET_DRIVER_ETH1
 445     char eth1_ip[32], eth1_netmask[32], eth1_broadcast[32];
 446 #endif
 447     char *eth_gateway;
 448
 449     scan_args(cmdline, &argc, argv, &alt_cmdline);
 450     while (1) {
 451         i = getopt(argc, argv, "fqv");
 452         if (i < 0) break;
 453         switch (i) {
 454         case 'f':
 455             force_dump = true;
 456             break;
 457         case 'q':
 458             quick_boot = true;
 459             break;
 460         case 'v':
 461             verbose = true;
 462             break;
 463         default:
 464             diag_printf("Invalid return from getopt: %d\n", i);
 465         }
 466     }
 467     if (optind < argc) {
 468         boot_info = argv[optind];
 469     };
 470
 471     if (!(eth_gateway = nvram_get("net_gateway"))) {
 472         diag_printf("Error: need network gateway\n");
 473         return 1;
 474     }
 475 #ifdef CYGHWR_NET_DRIVER_ETH0
 476     if (!parse_eth_addrs(nvram_get("net0_ip"), nvram_get("net0_mask"),
 477                          eth0_ip, eth0_netmask, eth0_broadcast)) {
 478         diag_printf("Can't set up ethernet 'net0' - I give up!\n");
 479         return 1;
 480     }
 481     build_bootp_record(&eth0_bootp_data,
 482                        eth0_name,
 483                        eth0_ip,
 484                        eth0_netmask,
 485                        eth0_broadcast,
 486                        eth_gateway,
 487                        "0.0.0.0");
 488     show_bootp(eth0_name, &eth0_bootp_data);
 489     if (!init_net(eth0_name, &eth0_bootp_data)) {
 490         diag_printf("Network initialization failed for eth0\n");
 491     }
 492 #endif
 493 #ifdef CYGHWR_NET_DRIVER_ETH1
 494     if (!parse_eth_addrs(nvram_get("net1_ip"), nvram_get("net1_mask"),
 495                          eth1_ip, eth1_netmask, eth1_broadcast)) {
 496         diag_printf("Can't set up ethernet 'net1' - I give up!\n");
 497         return 1;
 498     }
 499     build_bootp_record(&eth1_bootp_data,
 500                        eth1_name,
 501                        eth1_ip,
 502                        eth1_netmask,
 503                        eth1_broadcast,
 504                        eth_gateway,
 505                        "0.0.0.0");
 506     show_bootp(eth1_name, &eth1_bootp_data);
 507     if (!init_net(eth1_name, &eth1_bootp_data)) {
 508         diag_printf("Network initialization failed for eth1\n");
 509     }
 510 #endif
 511
 512     if (!quick_boot) {
 513         if (!force_dump) {
 514             // See if the 'core dump' page contains an indication that a
 515             // dump should be taken
 516             force_dump = true;
 517         }
 518         do_core_dump(&test_core_info, eth0_ip);
 519     }
 520
 521     do_load(boot_info);
 522
 523     len = ftp_get("192.168.1.125", "gthomas", "Zorkle!!", "TEST.dat",
 524                   (char *)0x200000, 0x100000, ftpclient_printf);
 525     diag_printf("res = %d\n", len);
 526     if (len <= 0) exit(0);
 527     wlen = ftp_put("192.168.1.125", "gthomas", "Zorkle!!", "TEST2.dat",
 528                    (char *)0x200000, len, ftpclient_printf);
 529     diag_printf("res = %d\n", wlen);
 530
 531     // Set up to compress data
 532     gp.ptr = (char *)0x200000;
 533     gp.len = len;
 534     dp.len = 0;
 535     dp.get_data = simple_get_data;
 536     dp.get_param = &gp;
 537     dp.src_len = 1;
 538     dp.first = 1;
 539     dp.stream.next_in = 0;
 540     dp.stream.avail_in = 0x1000;
 541     dp.stream.next_out = dp.buf;
 542     dp.stream.avail_out = FTP_BUFSIZE;
 543     dp.stream.zalloc = (alloc_func)0;
 544     dp.stream.zfree = (free_func)0;
 545     dp.stream.opaque = (voidpf)0;
 546
 547     err = deflateInit(&dp.stream, Z_DEFAULT_COMPRESSION);
 548     diag_printf("err = %d\n", err);
 549     wlen = ftp_put_var("192.168.1.125", "gthomas", "Zorkle!!", "TEST3.dat.gz",
 550                        _ftp_write_gz, &dp, ftpclient_printf);
 551     diag_printf("res = %d\n", wlen);
 552     deflateEnd(&dp.stream);
 553
 554     return 0;
 555 }
 556
 557 int
 558 main(void)
 559 {
 560     return (loader_main("-f -t test joe -- junk"));
 561 }
 562 #endif // _config_OK