2 * Copyright (c) 2020 Tilman Sauerbeck (tilman at code-monkey de)
4 * Permission is hereby granted, free of charge, to any person obtaining
5 * a copy of this software and associated documentation files (the
6 * "Software"), to deal in the Software without restriction, including
7 * without limitation the rights to use, copy, modify, merge, publish,
8 * distribute, sublicense, and/or sell copies of the Software, and to
9 * permit persons to whom the Software is furnished to do so, subject to
10 * the following conditions:
12 * The above copyright notice and this permission notice shall be
13 * included in all copies or substantial portions of the Software.
15 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
16 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
17 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
18 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
19 * LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
20 * OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
21 * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
28 const SECTOR_SIZE: usize = 4096;
47 const SR_WIP: u8 = 1 << 0;
50 pub fn new(cs_gpio: u32, cs_gpio_pin: u32) -> Mx25l {
53 cs_gpio_pin: cs_gpio_pin,
57 pub fn read_status(&self) -> u8 {
58 self.with_selected(|| {
59 spi::tx8(spi::SPI0, Command::RDSR as u8);
61 spi::tx8(spi::SPI0, 0xff)
65 pub fn read_id(&self) -> (u8, u16) {
66 self.with_selected(|| {
67 spi::tx8(spi::SPI0, Command::RDID as u8);
69 let manufacturer_id = spi::tx8(spi::SPI0, 0xff);
70 let device_id0 = spi::tx8(spi::SPI0, 0xff) as u16;
71 let device_id1 = spi::tx8(spi::SPI0, 0xff) as u16;
73 (manufacturer_id, device_id0 | (device_id1 << 8))
77 pub fn erase_sector(&self, address: usize) -> Result<(), Error> {
78 if (address & (SECTOR_SIZE - 1)) != 0 {
79 return Err(Error::UnalignedAddress);
84 self.with_selected(|| {
85 spi::tx8(spi::SPI0, Command::SE as u8);
87 spi::tx8(spi::SPI0, (address >> 16) as u8);
88 spi::tx8(spi::SPI0, (address >> 8) as u8);
89 spi::tx8(spi::SPI0, (address >> 0) as u8);
92 while self.write_in_progress() {
98 fn write_enable(&self) {
99 self.with_selected(|| {
100 spi::tx8(spi::SPI0, Command::WREN as u8);
104 fn write_in_progress(&self) -> bool {
105 (self.read_status() & SR_WIP) != 0
108 fn with_selected<F, T>(&self, func: F) -> T
109 where F: FnOnce() -> T
111 gpio::clear(self.cs_gpio, self.cs_gpio_pin);
115 gpio::set(self.cs_gpio, self.cs_gpio_pin);
121 impl Storage for Mx25l {
122 fn read(&self, address: usize, buffer: &mut [u8]) {
123 self.with_selected(|| {
124 spi::tx8(spi::SPI0, Command::READ as u8);
126 spi::tx8(spi::SPI0, (address >> 16) as u8);
127 spi::tx8(spi::SPI0, (address >> 8) as u8);
128 spi::tx8(spi::SPI0, (address >> 0) as u8);
130 for i in 0..buffer.len() {
131 buffer[i] = spi::tx8(spi::SPI0, 0xff);