147 lines
4.0 KiB
C
147 lines
4.0 KiB
C
/*
|
|
ChibiOS - Copyright (C) 2006..2016 Giovanni Di Sirio
|
|
|
|
Licensed under the Apache License, Version 2.0 (the "License");
|
|
you may not use this file except in compliance with the License.
|
|
You may obtain a copy of the License at
|
|
|
|
http://www.apache.org/licenses/LICENSE-2.0
|
|
|
|
Unless required by applicable law or agreed to in writing, software
|
|
distributed under the License is distributed on an "AS IS" BASIS,
|
|
WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
See the License for the specific language governing permissions and
|
|
limitations under the License.
|
|
*/
|
|
|
|
#include "ch.h"
|
|
#include "hal.h"
|
|
|
|
#include "m25q.h"
|
|
|
|
/*
|
|
* Maximum speed SPI configuration (18MHz, CPHA=0, CPOL=0, MSb first).
|
|
*/
|
|
static const SPIConfig hs_spicfg = {
|
|
false,
|
|
NULL,
|
|
GPIOB,
|
|
12,
|
|
0,
|
|
SPI_CR2_DS_2 | SPI_CR2_DS_1 | SPI_CR2_DS_0
|
|
};
|
|
|
|
/*
|
|
* Flash driver configuration.
|
|
*/
|
|
static const M25QConfig flashcfg = {
|
|
&SPID2,
|
|
&hs_spicfg
|
|
};
|
|
|
|
/*
|
|
* Flash driver object.
|
|
*/
|
|
static M25QDriver flash;
|
|
|
|
/*
|
|
* Generic buffer.
|
|
*/
|
|
uint8_t buffer[2048];
|
|
|
|
const uint8_t pattern[128] = {
|
|
0, 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,
|
|
0, 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,
|
|
0, 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,
|
|
0, 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
|
|
};
|
|
|
|
/*
|
|
* LED blinker thread, times are in milliseconds.
|
|
*/
|
|
static THD_WORKING_AREA(waThread1, 128);
|
|
static THD_FUNCTION(Thread1, arg) {
|
|
|
|
(void)arg;
|
|
chRegSetThreadName("blinker");
|
|
while (true) {
|
|
palToggleLine(LINE_LED3_RED);
|
|
chThdSleepMilliseconds(500);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Application entry point.
|
|
*/
|
|
int main(void) {
|
|
flash_error_t err;
|
|
|
|
/*
|
|
* System initializations.
|
|
* - HAL initialization, this also initializes the configured device drivers
|
|
* and performs the board-specific initializations.
|
|
* - Kernel initialization, the main() function becomes a thread and the
|
|
* RTOS is active.
|
|
*/
|
|
halInit();
|
|
chSysInit();
|
|
|
|
/*
|
|
* Creates the blinker thread.
|
|
*/
|
|
chThdCreateStatic(waThread1, sizeof(waThread1), NORMALPRIO + 1, Thread1, NULL);
|
|
|
|
/*
|
|
* SPI2 I/O pins setup.
|
|
*/
|
|
palSetPad(GPIOB, 12);
|
|
palSetPadMode(GPIOB, 12, PAL_MODE_OUTPUT_PUSHPULL |
|
|
PAL_STM32_OSPEED_HIGHEST); /* New CS. */
|
|
palSetPadMode(GPIOB, 13, PAL_MODE_ALTERNATE(5) |
|
|
PAL_STM32_OSPEED_HIGHEST); /* New SCK. */
|
|
palSetPadMode(GPIOB, 14, PAL_MODE_ALTERNATE(5) |
|
|
PAL_STM32_OSPEED_HIGHEST); /* New MISO. */
|
|
palSetPadMode(GPIOB, 15, PAL_MODE_ALTERNATE(5) |
|
|
PAL_STM32_OSPEED_HIGHEST); /* New MOSI. */
|
|
|
|
/*
|
|
* Initializing and starting flash driver.
|
|
*/
|
|
m25qObjectInit(&flash);
|
|
m25qStart(&flash, &flashcfg);
|
|
|
|
/* Programming a pattern.*/
|
|
err = flashProgram(&flash, 0, 128, pattern);
|
|
if (err != FLASH_NO_ERROR)
|
|
chSysHalt("program error");
|
|
|
|
/* Reading it back.*/
|
|
err = flashRead(&flash, 0, 128, buffer);
|
|
if (err != FLASH_NO_ERROR)
|
|
chSysHalt("read error");
|
|
|
|
/* Erasing the containing sector and waiting for completion.*/
|
|
(void) flashStartEraseSector(&flash, 0);
|
|
err = flashWaitErase((BaseFlash *)&flash);
|
|
if (err != FLASH_NO_ERROR)
|
|
chSysHalt("erase error");
|
|
|
|
/* Verifying the erase operation.*/
|
|
err = flashVerifyErase(&flash, 0);
|
|
if (err != FLASH_NO_ERROR)
|
|
chSysHalt("verify erase error");
|
|
|
|
/* Reading back for confirmation.*/
|
|
err = flashRead(&flash, 0, 128, buffer);
|
|
if (err != FLASH_NO_ERROR)
|
|
chSysHalt("read error");
|
|
|
|
while (true) {
|
|
chThdSleepMilliseconds(500);
|
|
}
|
|
}
|