|
- /* Optimized SD Library for Teensy 3.X
- * Copyright (c) 2015, Paul Stoffregen, paul@pjrc.com
- *
- * Development of this SD library was funded by PJRC.COM, LLC by sales of
- * Teensy and Audio Adaptor boards. Please support PJRC's efforts to develop
- * open source software by purchasing genuine Teensy or other PJRC products.
- *
- * Permission is hereby granted, free of charge, to any person obtaining a copy
- * of this software and associated documentation files (the "Software"), to deal
- * in the Software without restriction, including without limitation the rights
- * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
- * copies of the Software, and to permit persons to whom the Software is
- * furnished to do so, subject to the following conditions:
- *
- * The above copyright notice, development funding notice, and this permission
- * notice shall be included in all copies or substantial portions of the Software.
- *
- * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
- * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
- * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
- * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
- * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
- * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
- * THE SOFTWARE.
- */
-
- #if defined(__arm__)
- #include "SD_t3.h"
- #ifdef USE_TEENSY3_OPTIMIZED_CODE
-
- #define sector_t SDClass::sector_t
-
- File::File()
- {
- type = FILE_INVALID;
- namestr[0] = 0;
- }
-
- File::~File(void)
- {
- close();
- }
-
- size_t File::write(uint8_t b)
- {
- return write(&b, 1);
- }
-
- size_t File::write(const uint8_t *buf, size_t size)
- {
- if (type != FILE_WRITE) {
- setWriteError();
- return 0;
- }
- // TODO: a lot of work....
- return 0;
- }
-
- int File::read()
- {
- uint8_t b;
- int ret = read(&b, 1);
- if (ret != 1) return -1;
- return b;
- }
-
- int File::peek()
- {
- uint32_t save_offset = offset;
- uint32_t save_cluster = current_cluster;
- uint8_t b;
- int ret = read(&b, 1);
- if (ret != 1) return -1;
- offset = save_offset;
- current_cluster = save_cluster;
- return b;
- }
-
- int File::available()
- {
- if (type > FILE_WRITE) return 0;
- uint32_t maxsize = length - offset;
- if (maxsize > 0x7FFFFFFF) maxsize = 0x7FFFFFFF;
- return maxsize;
- }
-
- void File::flush()
- {
-
- }
-
- int File::read(void *buf, uint32_t size)
- {
- if (type > FILE_WRITE) return 0;
- uint32_t maxsize = length - offset;
- if (size > maxsize) size = maxsize;
- if (size == 0) return 0;
- uint32_t count = 0;
- uint8_t *dest = (uint8_t *)buf;
- uint32_t lba = custer_to_sector(current_cluster);
- uint32_t sindex = cluster_offset(offset);
-
- //Serial.printf(" read %u at %u (%X)\n", size, offset, offset);
-
- lba += sindex >> 9;
- sindex &= 511;
- if (sindex) {
- // first read starts in the middle of a sector
- do {
- SDCache cache;
- sector_t *sector = cache.read(lba);
- if (!sector) {
- //Serial.println(" read err1, unable to read");
- return 0;
- }
- uint32_t n = 512 - sindex;
- if (size < n) {
- // read does not consume all of the sector
- memcpy(dest, sector->u8 + sindex, size);
- offset += size;
- //cache.priority(+1);
- return size;
- } else {
- // read fully consumes this sector
- memcpy(dest, sector->u8 + sindex, n);
- dest += n;
- count = n;
- offset += n;
- //cache.priority(-1);
- }
- } while (0);
- if (is_new_cluster(++lba)) {
- if (!next_cluster()) {
- //Serial.print(" read err1, next cluster");
- return count;
- }
- }
- if (count >= size) return count;
- }
- while (1) {
- // every read starts from the beginning of a sector
- do {
- SDCache cache;
- uint32_t n = size - count;
- if (n < 512) {
- // only part of a sector is needed
- sector_t *sector = cache.read(lba);
- if (!sector) {
- //Serial.println(" read err2, unable to read");
- return count;
- }
- memcpy(dest, sector->u8, n);
- offset += n;
- count += n;
- //cache.priority(+1);
- return count;
- } else {
- // a full sector is required
- if (!cache.read(lba, dest)) return count;
- dest += 512;
- offset += 512;
- count += 512;
- }
- } while (0);
- if (is_new_cluster(++lba)) {
- if (!next_cluster()) {
- //Serial.print(" read err2, next cluster");
- return count;
- }
- }
- if (count >= size) return count;
- }
- }
-
- bool File::seek(uint32_t pos)
- {
- if (type > FILE_WRITE) return false;
- if (pos > length) return false;
-
- //Serial.printf(" seek to %u\n", pos);
- uint32_t save_cluster = current_cluster;
- uint32_t count;
- // TODO: if moving to a new lba, lower cache priority
- signed int diff = (int)cluster_number(pos) - (int)cluster_number(offset);
- if (diff >= 0) {
- // seek fowards, 0 or more clusters from current position
- count = diff;
- } else {
- // seek backwards, need to start from beginning of file
- current_cluster = start_cluster;
- count = cluster_number(pos);
- }
- while (count > 0) {
- if (!next_cluster()) {
- current_cluster = save_cluster;
- return false;
- }
- count--;
- }
- offset = pos;
- return true;
- }
-
- void File::close()
- {
- type = FILE_INVALID;
- namestr[0] = 0;
- }
-
- #endif
- #endif
|