RT_Firmware_Libs/flash.cpp at master · MIT-Rocket-Team/RT_Firmware_Libs · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
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
#include "Arduino.h"
#include "SPI.h"
#include "flash.h"

flash::flash(SPIClass* SPI, SPISettings settings, int cs) {
    _SPI = SPI;
    _settings = settings;
    _cs = cs;
}

uint8_t flash::readStatusRegister() {
    digitalWrite(_cs, 0);
    _SPI->beginTransaction(_settings);
    _SPI->transfer(0x05);
    uint8_t status = _SPI->transfer(0x00);
    _SPI->endTransaction();
    digitalWrite(_cs, 1);
    return status;
}
void flash::begin() {
    pinMode(_cs, OUTPUT);
    digitalWrite(_cs, 1);
}

void flash::programPage(uint8_t* data, uint32_t adr) {
    writeEnable();
    digitalWrite(_cs, 0);
    _SPI->beginTransaction(_settings);
    _SPI->transfer(0x02);
    _SPI->transfer(adr >> 16);
    _SPI->transfer(adr >> 8);
    _SPI->transfer(adr);
    _SPI->transfer(data, 512);
    _SPI->endTransaction();
    digitalWrite(_cs, 1);
    writeEnable();
}

void flash::readPage(uint8_t* data, uint32_t adr) {
    digitalWrite(_cs, 0);
    _SPI->beginTransaction(_settings);
    _SPI->transfer(0x03);
    _SPI->transfer(adr >> 16);
    _SPI->transfer(adr >> 8);
    _SPI->transfer(adr);
    _SPI->transfer(data, 512);
    _SPI->endTransaction();
    digitalWrite(_cs, 1);
}

void flash::sectorErase(uint32_t adr) {
    writeEnable();
    digitalWrite(_cs, 0);
    _SPI->beginTransaction(_settings);
    _SPI->transfer(0xD8);
    _SPI->transfer(adr >> 16);
    _SPI->transfer(adr >> 8);
    _SPI->transfer(adr);
    _SPI->endTransaction();
    digitalWrite(_cs, 1);
    writeEnable();
}

void flash::writeEnable() {
    digitalWrite(_cs, 0);
    _SPI->beginTransaction(_settings);
    _SPI->transfer(0x06);
    _SPI->endTransaction();
    digitalWrite(_cs, 1);
}

bool flash::isBusy() {
    digitalWrite(_cs, 0);
    _SPI->beginTransaction(_settings);
    _SPI->transfer(0x05);
    uint8_t status = _SPI->transfer(0x00);
    _SPI->endTransaction();
    digitalWrite(_cs, 1);
    return (status & 0x01);
}

void flash::eraseFlash() {
    writeEnable();
    digitalWrite(_cs, 0);
    _SPI->beginTransaction(_settings);
    _SPI->transfer(0xC7);
    _SPI->endTransaction();
    digitalWrite(_cs, 1);
}