busybox

/* fdformat.c  -  Low-level formats a floppy disk - Werner Almesberger */

​

/* 1999-02-22 Arkadiusz Mi¶kiewicz <misiek@pld.ORG.PL>

 * - added Native Language Support

 * 1999-03-20 Arnaldo Carvalho de Melo <acme@conectiva.com.br>

 * - more i18n/nls translatable strings marked

 *

 * 5 July 2003 -- modified for Busybox by Erik Andersen

 */

​

#include <stdio.h>

#include <string.h>

#include <fcntl.h>

#include <errno.h>

#include <unistd.h>

#include <stdlib.h>

#include <sys/stat.h>

#include <sys/ioctl.h>

#include "busybox.h"

​

​

/* Stuff extracted from linux/fd.h */

struct floppy_struct {

    unsigned int    size,       /* nr of sectors total */

            sect,       /* sectors per track */

            head,       /* nr of heads */

            track,      /* nr of tracks */

            stretch;    /* !=0 means double track steps */

#define FD_STRETCH 1

#define FD_SWAPSIDES 2

​

    unsigned char   gap,        /* gap1 size */

​

            rate,       /* data rate. |= 0x40 for perpendicular */

#define FD_2M 0x4

#define FD_SIZECODEMASK 0x38

#define FD_SIZECODE(floppy) (((((floppy)->rate&FD_SIZECODEMASK)>> 3)+ 2) %8)

#define FD_SECTSIZE(floppy) ( (floppy)->rate & FD_2M ? \

                 512 : 128 << FD_SIZECODE(floppy) )

#define FD_PERP 0x40

​

            spec1,      /* stepping rate, head unload time */

            fmt_gap;    /* gap2 size */

    const char  * name; /* used only for predefined formats */

};

struct format_descr {

    unsigned int device,head,track;

};

#define FDFMTBEG _IO(2,0x47)

#define FDFMTTRK _IOW(2,0x48, struct format_descr)

#define FDFMTEND _IO(2,0x49)

#define FDGETPRM _IOR(2, 0x04, struct floppy_struct)

#define FD_FILL_BYTE 0xF6 /* format fill byte. */

​

static void print_and_flush(const char * __restrict format, ...)

{

    va_list arg;

​

    va_start(arg, format);

    bb_vfprintf(stdout, format, arg);

    va_end(arg);

    bb_xfflush_stdout();

}