123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546 |
- /*
- * Filesystem library
- * Handles all filesystem related work for userBDOS programs using CH376.
- * Uses only bottom USB port (SPI1 CH376),
- * allowing top USB top to be used for other USB devices (like HID).
- * Uses blocking delays for now.
- */
- // uses stdlib.c
- #define FS_INTERRUPT_ADDR 0xC0272D
- //CH376 Codes
- #define FS_CMD_GET_IC_VER 0x01
- #define FS_CMD_SET_BAUDRATE 0x02
- #define FS_CMD_ENTER_SLEEP 0x03
- #define FS_CMD_SET_USB_SPEED 0x04
- #define FS_CMD_RESET_ALL 0x05
- #define FS_CMD_CHECK_EXIST 0x06
- #define FS_CMD_SET_SD0_INT 0x0b
- #define FS_CMD_SET_RETRY 0x0b
- #define FS_CMD_GET_FILE_SIZE 0x0c
- #define FS_CMD_SET_FILE_SIZE 0x0d
- #define FS_CMD_SET_USB_ADDRESS 0x13
- #define FS_CMD_SET_USB_MODE 0x15
- #define FS_MODE_HOST_0 0x05
- #define FS_MODE_HOST_1 0x07
- #define FS_MODE_HOST_2 0x06
- #define FS_CMD_GET_STATUS 0x22
- #define FS_CMD_RD_USB_DATA0 0x27
- #define FS_CMD_WR_USB_DATA 0x2c
- #define FS_CMD_WR_REQ_DATA 0x2d
- #define FS_CMD_WR_OFS_DATA 0x2e
- #define FS_CMD_SET_FILE_NAME 0x2f
- #define FS_CMD_DISK_CONNECT 0x30
- #define FS_CMD_DISK_MOUNT 0x31
- #define FS_CMD_FILE_OPEN 0x32
- #define FS_CMD_FILE_ENUM_GO 0x33
- #define FS_CMD_FILE_CREATE 0x34
- #define FS_CMD_FILE_ERASE 0x35
- #define FS_CMD_FILE_CLOSE 0x36
- #define FS_CMD_DIR_INFO_READ 0x37
- #define FS_CMD_DIR_INFO_SAVE 0x38
- #define FS_CMD_BYTE_LOCATE 0x39
- #define FS_CMD_BYTE_READ 0x3a
- #define FS_CMD_BYTE_RD_GO 0x3b
- #define FS_CMD_BYTE_WRITE 0x3c
- #define FS_CMD_BYTE_WR_GO 0x3d
- #define FS_CMD_DISK_CAPACITY 0x3e
- #define FS_CMD_DISK_QUERY 0x3f
- #define FS_CMD_DIR_CREATE 0x40
- #define FS_CMD_SET_ADDRESS 0x45
- #define FS_CMD_GET_DESCR 0x46
- #define FS_CMD_SET_CONFIG 0x49
- #define FS_CMD_AUTO_CONFIG 0x4D
- #define FS_CMD_ISSUE_TKN_X 0x4E
- #define FS_ANSW_RET_SUCCESS 0x51
- #define FS_ANSW_USB_INT_SUCCESS 0x14
- #define FS_ANSW_USB_INT_CONNECT 0x15
- #define FS_ANSW_USB_INT_DISCONNECT 0x16
- #define FS_ANSW_USB_INT_USB_READY 0x18
- #define FS_ANSW_USB_INT_DISK_READ 0x1d
- #define FS_ANSW_USB_INT_DISK_WRITE 0x1e
- #define FS_ANSW_RET_ABORT 0x5F
- #define FS_ANSW_USB_INT_DISK_ERR 0x1f
- #define FS_ANSW_USB_INT_BUF_OVER 0x17
- #define FS_ANSW_ERR_OPEN_DIR 0x41
- #define FS_ANSW_ERR_MISS_FILE 0x42
- #define FS_ANSW_ERR_FOUND_NAME 0x43
- #define FS_ANSW_ERR_DISK_DISCON 0x82
- #define FS_ANSW_ERR_LARGE_SECTOR 0x84
- #define FS_ANSW_ERR_TYPE_ERROR 0x92
- #define FS_ANSW_ERR_BPB_ERROR 0xa1
- #define FS_ANSW_ERR_DISK_FULL 0xb1
- #define FS_ANSW_ERR_FDT_OVER 0xb2
- #define FS_ANSW_ERR_FILE_CLOSE 0xb4
- #define FS_ERR_LONGFILENAME 0x01
- #define FS_ATTR_READ_ONLY 0x01
- #define FS_ATTR_HIDDEN 0x02
- #define FS_ATTR_SYSTEM 0x04
- #define FS_ATTR_VOLUME_ID 0x08
- #define FS_ATTR_DIRECTORY 0x10
- #define FS_ATTR_ARCHIVE 0x20
- // Sets SPI1_CS low
- void FS_spiBeginTransfer()
- {
- asm(
- "; backup regs\n"
- "push r1\n"
- "push r2\n"
- "load32 0xC0272C r2 ; r2 = 0xC0272C\n"
- "load 0 r1 ; r1 = 0 (enable)\n"
- "write 0 r2 r1 ; write to SPI1_CS\n"
- "; restore regs\n"
- "pop r2\n"
- "pop r1\n"
- );
- }
- // Sets SPI1_CS high
- void FS_spiEndTransfer()
- {
- asm(
- "; backup regs\n"
- "push r1\n"
- "push r2\n"
- "load32 0xC0272C r2 ; r2 = 0xC0272C\n"
- "load 1 r1 ; r1 = 1 (disable)\n"
- "write 0 r2 r1 ; write to SPI1_CS\n"
- "; restore regs\n"
- "pop r2\n"
- "pop r1\n"
- );
- }
- // write dataByte and return read value
- // write 0x00 for a read
- // Writes byte over SPI1 to CH376
- word FS_spiTransfer(word dataByte)
- {
- word retval = 0;
- asm(
- "load32 0xC0272B r2 ; r2 = 0xC0272B\n"
- "write 0 r2 r4 ; write r4 over SPI1\n"
- "read 0 r2 r2 ; read return value\n"
- "write -4 r14 r2 ; write to stack to return\n"
- );
- return retval;
- }
- // Get status after waiting for an interrupt
- word FS_WaitGetStatus()
- {
- word intValue = 1;
- while(intValue)
- {
- word *i = (word *) FS_INTERRUPT_ADDR;
- intValue = *i;
- }
- FS_spiBeginTransfer();
- FS_spiTransfer(FS_CMD_GET_STATUS);
- FS_spiEndTransfer();
- //delay(1);
- FS_spiBeginTransfer();
- word retval = FS_spiTransfer(0x00);
- FS_spiEndTransfer();
- return retval;
- }
- // Function to send a string (without terminating 0)
- void FS_sendString(char* str)
- {
- char chr = *str; // first character of str
- while (chr != 0) // continue until null value
- {
- FS_spiTransfer(chr);
- str++; // go to next character address
- chr = *str; // get character from address
- }
- }
- // Function to send data d of size s
- void FS_sendData(char* d, word s)
- {
- char chr = *d; // first byte of data
- word i;
- for(i = 0; (unsigned int) i < (unsigned int)s; i++) // write s bytes
- {
- FS_spiTransfer(chr);
- d++; // go to next data address
- chr = *d; // get data from address
- }
- }
- // Returns file size of currently opened file (32 bits)
- word FS_getFileSize()
- {
- FS_spiBeginTransfer();
- FS_spiTransfer(FS_CMD_GET_FILE_SIZE);
- FS_spiTransfer(0x68);
- word retval = FS_spiTransfer(0);
- retval = retval + (FS_spiTransfer(0) << 8);
- retval = retval + (FS_spiTransfer(0) << 16);
- retval = retval + (FS_spiTransfer(0) << 24);
- FS_spiEndTransfer();
- return retval;
- }
- // Sets cursor to position s
- // Returns FS_ANSW_USB_INT_SUCCESS on success
- word FS_setCursor(word s)
- {
- FS_spiBeginTransfer();
- FS_spiTransfer(FS_CMD_BYTE_LOCATE);
- FS_spiTransfer(s);
- FS_spiTransfer(s >> 8);
- FS_spiTransfer(s >> 16);
- FS_spiTransfer(s >> 24);
- FS_spiEndTransfer();
- return FS_WaitGetStatus();
- }
- // Reads s bytes into buf
- // If bytesToWord is true, four bytes will be stored in one address/word
- // Can read 65536 bytes per call
- // Returns FS_ANSW_USB_INT_SUCCESS on success
- // TODO: this surely can be optimized for speed in some way!
- word FS_readFile(char* buf, word s, word bytesToWord)
- {
- if (s == 0)
- return FS_ANSW_USB_INT_SUCCESS;
- FS_spiBeginTransfer();
- FS_spiTransfer(FS_CMD_BYTE_READ);
- FS_spiTransfer(s);
- FS_spiTransfer(s >> 8);
- FS_spiEndTransfer();
- word retval = FS_WaitGetStatus();
- // Return on error or EOF
- if (retval == FS_ANSW_USB_INT_SUCCESS) // eof
- return 0;
- if (retval != FS_ANSW_USB_INT_DISK_READ)
- return retval;
- word bytesRead = 0;
- word wordsRead = 0;
- word doneReading = 0;
- // clear first address
- buf[wordsRead] = 0;
- // used for shifting bytes to word
- word currentByteShift = 24;
- while (doneReading == 0)
- {
- // Read set of bytes (max 255)
- FS_spiBeginTransfer();
- FS_spiTransfer(FS_CMD_RD_USB_DATA0);
- word readLen = FS_spiTransfer(0x00);
- word readByte;
- word i;
- for (i = 0; i < readLen; i++)
- {
- readByte = FS_spiTransfer(0x00);
- // Read 4 bytes into one word, from left to right
- if (bytesToWord)
- {
- readByte = readByte << currentByteShift;
- buf[wordsRead] = buf[wordsRead] + readByte;
- if (currentByteShift == 0)
- {
- currentByteShift = 24;
- wordsRead++;
- buf[wordsRead] = 0;
- }
- else
- {
- currentByteShift -= 8;
- }
- }
- else
- {
- buf[bytesRead] = (char)readByte;
- bytesRead = bytesRead + 1;
- }
- }
- FS_spiEndTransfer();
- // requesting another set of data
- FS_spiBeginTransfer();
- FS_spiTransfer(FS_CMD_BYTE_RD_GO);
- FS_spiEndTransfer();
- retval = FS_WaitGetStatus();
- if (retval == FS_ANSW_USB_INT_SUCCESS)
- doneReading = 1;
- else if (retval == FS_ANSW_USB_INT_DISK_READ)
- {
- // read another block
- }
- else
- {
- uprintln("E: Error while reading data");
- return retval;
- }
- }
- return retval;
- }
- // Writes data d of size s
- // Can only write 65536 bytes at a time
- // returns FS_ANSW_USB_INT_SUCCESS on success
- // TODO: optimize for speed
- word FS_writeFile(char* d, word s)
- {
- if (s == 0)
- return FS_ANSW_USB_INT_SUCCESS;
- FS_spiBeginTransfer();
- FS_spiTransfer(FS_CMD_BYTE_WRITE);
- FS_spiTransfer(s);
- FS_spiTransfer(s >> 8);
- FS_spiEndTransfer();
- word retval = FS_WaitGetStatus();
- // Return on error
- if (retval != FS_ANSW_USB_INT_DISK_WRITE)
- return retval;
- word bytesWritten = 0;
- word doneWriting = 0;
- while (doneWriting == 0)
- {
- // Write set of bytes (max 255)
- FS_spiBeginTransfer();
- FS_spiTransfer(FS_CMD_WR_REQ_DATA);
- word wrLen = FS_spiTransfer(0x00);
- FS_sendData(d + bytesWritten, wrLen);
- bytesWritten = bytesWritten + wrLen;
- FS_spiEndTransfer();
- // update file size
- FS_spiBeginTransfer();
- FS_spiTransfer(FS_CMD_BYTE_WR_GO);
- FS_spiEndTransfer();
- retval = FS_WaitGetStatus();
- if (retval == FS_ANSW_USB_INT_SUCCESS)
- doneWriting = 1;
- else if (retval == FS_ANSW_USB_INT_DISK_WRITE)
- {
- // write another block
- }
- else
- {
- uprintln("E: Error while writing data");
- return retval;
- }
- }
-
- return retval;
- }
- // returns status of opening a file/directory
- // Usually the successful status codes are:
- // FS_ANSW_USB_INT_SUCCESS || FS_ANSW_ERR_OPEN_DIR || FS_ANSW_USB_INT_DISK_READ
- word FS_open()
- {
- FS_spiBeginTransfer();
- FS_spiTransfer(FS_CMD_FILE_OPEN);
- FS_spiEndTransfer();
- return FS_WaitGetStatus();
- }
- // returns FS_ANSW_USB_INT_SUCCESS on success
- word FS_close()
- {
- FS_spiBeginTransfer();
- FS_spiTransfer(FS_CMD_FILE_CLOSE);
- FS_spiTransfer(0x01); //0x01 if update filesize, else 0x00
- FS_spiEndTransfer();
- return FS_WaitGetStatus();
- }
- // Creates file (recreates if exists)
- // New files are 1 byte long
- // Have not found a way to set it to 0 bytes,
- // since FS_CMD_SET_FILE_SIZE does not work
- // Automatically closes file
- // returns FS_ANSW_USB_INT_SUCCESS on success
- word FS_createFile()
- {
- FS_spiBeginTransfer();
- FS_spiTransfer(FS_CMD_FILE_CREATE);
- FS_spiEndTransfer();
- word retval = FS_WaitGetStatus();
- // Return on error
- if (retval != FS_ANSW_USB_INT_SUCCESS)
- return retval;
- // open and close file
- FS_open();
- FS_close();
- return FS_ANSW_USB_INT_SUCCESS;
- }
- // Sends single path f
- // No processing of f is done, it is directly sent
- // This means no error checking on file length!
- void FS_sendSinglePath(char* f)
- {
- // send buf
- FS_spiBeginTransfer();
- FS_spiTransfer(FS_CMD_SET_FILE_NAME);
- FS_sendString(f); // send file name
- FS_spiTransfer(0); // close with null
- FS_spiEndTransfer();
- }
- // Sends path f
- // Can be relative or absolute file or directory
- // REQUIRES CAPITAL LETTERS and must conform the 8.3 filename standard
- // Function can handle folders with forward slashes
- // returns FS_ANSW_USB_INT_SUCCESS on success
- word FS_sendFullPath(char* f)
- {
- // path to uppercase and replace backslash by slash
- word i = 0;
- while (f[i] != 0)
- {
- f[i] = toUpper(f[i]);
- if (f[i] == '\\')
- f[i] = '/';
- i++;
- }
- word removedSlash = 0; // to restore removed slash
- // remove (single) trailing slash if exists
- // we reuse i here since it points to the end of the path
- if (i > 1) // ignore the root path
- {
- if (f[i-1] == '/')
- {
- f[i-1] = 0;
- removedSlash = 1;
- }
- }
- // if first char is a /, then we go back to root
- if (f[0] == '/')
- {
- FS_sendSinglePath("/");
- FS_open();
- }
- i = 0;
- char buf[16]; // buffer for single folder/file name
- word bufi = 0;
- while (f[i] != 0)
- {
- // handle all directories
- if (f[i] == 47) // forward slash
- {
- // return error on opening folders containing a single or double dot
- if ((bufi == 1 && buf[0] == '.') || (bufi == 2 && buf[0] == '.' && buf[1] == '.'))
- return FS_ANSW_ERR_OPEN_DIR;
- // add null to end of buf
- buf[bufi] = 0;
- // send buf
- FS_spiBeginTransfer();
- FS_spiTransfer(FS_CMD_SET_FILE_NAME);
- FS_sendString(buf); // send folder name
- FS_spiTransfer(0); // close with null
- FS_spiEndTransfer();
- // reset bufi
- bufi = 0;
- // open folder
- word retval = FS_open();
- // Return on if failure / folder not found
- if (retval != FS_ANSW_USB_INT_SUCCESS && retval != FS_ANSW_ERR_OPEN_DIR)
- return retval;
- }
- else
- {
- buf[bufi] = f[i];
- bufi++;
- if (bufi > 13)
- return FS_ERR_LONGFILENAME; // exit if folder/file name is too long
- }
- i++;
- }
- if (removedSlash) // restore removed slash if there
- {
- f[i] = '/';
- f[i+1] = 0;
- }
- // handle filename itself (if any)
- // add null to end of buf
- buf[bufi] = 0;
- if (bufi == 0)
- return FS_ANSW_USB_INT_SUCCESS; // exit if there is no filename after the folder
- // return error on opening folders containing a single or double dot
- if ((bufi == 1 && buf[0] == '.') || (bufi == 2 && buf[0] == '.' && buf[1] == '.'))
- return FS_ANSW_ERR_OPEN_DIR;
- // send buf (last part of string)
- FS_spiBeginTransfer();
- FS_spiTransfer(FS_CMD_SET_FILE_NAME);
- FS_sendString(buf); // send file name
- FS_spiTransfer(0); // close with null
- FS_spiEndTransfer();
- return FS_ANSW_USB_INT_SUCCESS;
- }
|