2010-07-03 07:53:04 +00:00
|
|
|
/*
|
2011-03-18 18:38:08 +00:00
|
|
|
ChibiOS/RT - Copyright (C) 2006,2007,2008,2009,2010,
|
2012-01-21 14:29:42 +00:00
|
|
|
2011,2012 Giovanni Di Sirio.
|
2010-07-03 07:53:04 +00:00
|
|
|
|
|
|
|
This file is part of ChibiOS/RT.
|
|
|
|
|
|
|
|
ChibiOS/RT is free software; you can redistribute it and/or modify
|
|
|
|
it under the terms of the GNU General Public License as published by
|
|
|
|
the Free Software Foundation; either version 3 of the License, or
|
|
|
|
(at your option) any later version.
|
|
|
|
|
|
|
|
ChibiOS/RT is distributed in the hope that it will be useful,
|
|
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
GNU General Public License for more details.
|
|
|
|
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
|
|
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <stdio.h>
|
|
|
|
#include <string.h>
|
|
|
|
|
|
|
|
#include "ch.h"
|
|
|
|
#include "hal.h"
|
|
|
|
#include "test.h"
|
|
|
|
#include "shell.h"
|
2011-06-28 06:54:35 +00:00
|
|
|
#include "chprintf.h"
|
2010-07-03 07:53:04 +00:00
|
|
|
#include "evtimer.h"
|
|
|
|
#include "ff.h"
|
|
|
|
|
|
|
|
#define MAX_SPI_BITRATE 100
|
|
|
|
#define MIN_SPI_BITRATE 250
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief FS object.
|
|
|
|
*/
|
|
|
|
FATFS MMC_FS;
|
|
|
|
|
|
|
|
/**
|
|
|
|
* MMC driver instance.
|
|
|
|
*/
|
|
|
|
MMCDriver MMCD1;
|
|
|
|
|
|
|
|
/* FS mounted and ready.*/
|
|
|
|
static bool_t fs_ready = FALSE;
|
|
|
|
|
|
|
|
/* Maximum speed SPI configuration (__MHz, NCPHA=1, CPOL=0).*/
|
|
|
|
static SPIConfig hs_spicfg = {
|
2010-10-17 19:40:36 +00:00
|
|
|
NULL,
|
2010-07-03 07:53:04 +00:00
|
|
|
IOPORT1,
|
|
|
|
PIOA_CS_MMC,
|
|
|
|
(MAX_SPI_BITRATE << 8) | AT91C_SPI_NCPHA | AT91C_SPI_BITS_8
|
|
|
|
};
|
|
|
|
|
|
|
|
/* Low speed SPI configuration (192KHz, NCPHA=1, CPOL=0).*/
|
|
|
|
static SPIConfig ls_spicfg = {
|
2010-10-17 19:40:36 +00:00
|
|
|
NULL,
|
2010-07-03 07:53:04 +00:00
|
|
|
IOPORT1,
|
|
|
|
PIOA_CS_MMC,
|
|
|
|
(MIN_SPI_BITRATE << 8) | AT91C_SPI_NCPHA | AT91C_SPI_BITS_8
|
|
|
|
};
|
|
|
|
|
|
|
|
/* Card insertion verification.*/
|
|
|
|
static bool_t mmc_is_inserted(void) {
|
|
|
|
return !palReadPad(IOPORT2, PIOB_MMC_CP);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Card protection verification.*/
|
|
|
|
static bool_t mmc_is_protected(void) {
|
|
|
|
return palReadPad(IOPORT2, PIOB_MMC_WP);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Generic large buffer.*/
|
|
|
|
uint8_t fbuff[1024];
|
|
|
|
|
2011-06-28 06:54:35 +00:00
|
|
|
static FRESULT scan_files(BaseChannel *chp, char *path) {
|
2010-07-03 07:53:04 +00:00
|
|
|
FRESULT res;
|
|
|
|
FILINFO fno;
|
|
|
|
DIR dir;
|
|
|
|
int i;
|
|
|
|
char *fn;
|
|
|
|
|
|
|
|
res = f_opendir(&dir, path);
|
|
|
|
if (res == FR_OK) {
|
|
|
|
i = strlen(path);
|
|
|
|
for (;;) {
|
|
|
|
res = f_readdir(&dir, &fno);
|
|
|
|
if (res != FR_OK || fno.fname[0] == 0)
|
|
|
|
break;
|
|
|
|
if (fno.fname[0] == '.')
|
|
|
|
continue;
|
|
|
|
fn = fno.fname;
|
|
|
|
if (fno.fattrib & AM_DIR) {
|
2011-06-28 06:54:35 +00:00
|
|
|
path[i++] = '/';
|
|
|
|
strcpy(&path[i], fn);
|
|
|
|
res = scan_files(chp, path);
|
2010-07-03 07:53:04 +00:00
|
|
|
if (res != FR_OK)
|
|
|
|
break;
|
|
|
|
path[i] = 0;
|
|
|
|
}
|
|
|
|
else {
|
2011-06-28 06:54:35 +00:00
|
|
|
chprintf(chp, "%s/%s\r\n", path, fn);
|
2010-07-03 07:53:04 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return res;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*/
|
|
|
|
/* Command line related. */
|
|
|
|
/*===========================================================================*/
|
|
|
|
|
|
|
|
#define SHELL_WA_SIZE THD_WA_SIZE(1024)
|
|
|
|
#define TEST_WA_SIZE THD_WA_SIZE(256)
|
|
|
|
|
|
|
|
static void cmd_mem(BaseChannel *chp, int argc, char *argv[]) {
|
|
|
|
size_t n, size;
|
|
|
|
|
|
|
|
(void)argv;
|
|
|
|
if (argc > 0) {
|
2011-06-28 06:54:35 +00:00
|
|
|
chprintf(chp, "Usage: mem\r\n");
|
2010-07-03 07:53:04 +00:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
n = chHeapStatus(NULL, &size);
|
2011-06-28 06:54:35 +00:00
|
|
|
chprintf(chp, "core free memory : %u bytes\r\n", chCoreStatus());
|
|
|
|
chprintf(chp, "heap fragments : %u\r\n", n);
|
|
|
|
chprintf(chp, "heap free total : %u bytes\r\n", size);
|
2010-07-03 07:53:04 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static void cmd_threads(BaseChannel *chp, int argc, char *argv[]) {
|
2011-10-23 11:39:45 +00:00
|
|
|
static const char *states[] = {THD_STATE_NAMES};
|
2010-07-03 07:53:04 +00:00
|
|
|
Thread *tp;
|
|
|
|
|
|
|
|
(void)argv;
|
|
|
|
if (argc > 0) {
|
2011-06-28 06:54:35 +00:00
|
|
|
chprintf(chp, "Usage: threads\r\n");
|
2010-07-03 07:53:04 +00:00
|
|
|
return;
|
|
|
|
}
|
2011-06-28 06:54:35 +00:00
|
|
|
chprintf(chp, " addr stack prio refs state time\r\n");
|
2010-07-03 07:53:04 +00:00
|
|
|
tp = chRegFirstThread();
|
|
|
|
do {
|
2011-06-28 06:54:35 +00:00
|
|
|
chprintf(chp, "%.8lx %.8lx %4lu %4lu %9s %lu\r\n",
|
|
|
|
(uint32_t)tp, (uint32_t)tp->p_ctx.r13,
|
|
|
|
(uint32_t)tp->p_prio, (uint32_t)(tp->p_refs - 1),
|
|
|
|
states[tp->p_state], (uint32_t)tp->p_time);
|
2010-07-03 07:53:04 +00:00
|
|
|
tp = chRegNextThread(tp);
|
|
|
|
} while (tp != NULL);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void cmd_test(BaseChannel *chp, int argc, char *argv[]) {
|
|
|
|
Thread *tp;
|
|
|
|
|
|
|
|
(void)argv;
|
|
|
|
if (argc > 0) {
|
2011-06-28 06:54:35 +00:00
|
|
|
chprintf(chp, "Usage: test\r\n");
|
2010-07-03 07:53:04 +00:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
tp = chThdCreateFromHeap(NULL, TEST_WA_SIZE, chThdGetPriority(),
|
|
|
|
TestThread, chp);
|
|
|
|
if (tp == NULL) {
|
2011-06-28 06:54:35 +00:00
|
|
|
chprintf(chp, "out of memory\r\n");
|
2010-07-03 07:53:04 +00:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
chThdWait(tp);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void cmd_tree(BaseChannel *chp, int argc, char *argv[]) {
|
|
|
|
FRESULT err;
|
|
|
|
uint32_t clusters;
|
|
|
|
FATFS *fsp;
|
|
|
|
|
|
|
|
(void)argv;
|
|
|
|
if (argc > 0) {
|
2011-06-28 06:54:35 +00:00
|
|
|
chprintf(chp, "Usage: tree\r\n");
|
2010-07-03 07:53:04 +00:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
if (!fs_ready) {
|
2011-06-28 06:54:35 +00:00
|
|
|
chprintf(chp, "File System not mounted\r\n");
|
2010-07-03 07:53:04 +00:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
err = f_getfree("/", &clusters, &fsp);
|
|
|
|
if (err != FR_OK) {
|
2011-06-28 06:54:35 +00:00
|
|
|
chprintf(chp, "FS: f_getfree() failed\r\n");
|
2010-07-03 07:53:04 +00:00
|
|
|
return;
|
|
|
|
}
|
2011-06-28 06:54:35 +00:00
|
|
|
chprintf(chp,
|
|
|
|
"FS: %lu free clusters, %lu sectors per cluster, %lu bytes free\r\n",
|
2010-07-03 07:53:04 +00:00
|
|
|
clusters, (uint32_t)MMC_FS.csize,
|
|
|
|
clusters * (uint32_t)MMC_FS.csize * (uint32_t)MMC_SECTOR_SIZE);
|
|
|
|
fbuff[0] = 0;
|
2011-06-28 06:54:35 +00:00
|
|
|
scan_files(chp, (char *)fbuff);
|
2010-07-03 07:53:04 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static const ShellCommand commands[] = {
|
|
|
|
{"mem", cmd_mem},
|
|
|
|
{"threads", cmd_threads},
|
|
|
|
{"test", cmd_test},
|
|
|
|
{"tree", cmd_tree},
|
|
|
|
{NULL, NULL}
|
|
|
|
};
|
|
|
|
|
|
|
|
static const ShellConfig shell_cfg1 = {
|
|
|
|
(BaseChannel *)&SD1,
|
|
|
|
commands
|
|
|
|
};
|
|
|
|
|
|
|
|
/*
|
|
|
|
* LCD blinker thread, times are in milliseconds.
|
|
|
|
*/
|
2010-11-20 11:21:36 +00:00
|
|
|
static WORKING_AREA(waThread1, 128);
|
2010-07-03 07:53:04 +00:00
|
|
|
static msg_t Thread1(void *p) {
|
|
|
|
|
|
|
|
(void)p;
|
2011-07-10 06:50:12 +00:00
|
|
|
chRegSetThreadName("blinker");
|
2010-07-03 07:53:04 +00:00
|
|
|
while (TRUE) {
|
|
|
|
palSetPad(IOPORT2, PIOB_LCD_BL);
|
|
|
|
chThdSleepMilliseconds(100);
|
|
|
|
palClearPad(IOPORT2, PIOB_LCD_BL);
|
|
|
|
chThdSleepMilliseconds(900);
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* MMC card insertion event.
|
|
|
|
*/
|
|
|
|
static void InsertHandler(eventid_t id) {
|
|
|
|
FRESULT err;
|
|
|
|
|
|
|
|
(void)id;
|
|
|
|
/*
|
|
|
|
* On insertion MMC initialization and FS mount.
|
|
|
|
*/
|
|
|
|
if (mmcConnect(&MMCD1)) {
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
err = f_mount(0, &MMC_FS);
|
|
|
|
if (err != FR_OK) {
|
|
|
|
mmcDisconnect(&MMCD1);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
fs_ready = TRUE;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* MMC card removal event.
|
|
|
|
*/
|
|
|
|
static void RemoveHandler(eventid_t id) {
|
|
|
|
|
|
|
|
(void)id;
|
|
|
|
fs_ready = FALSE;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
2010-12-19 10:25:31 +00:00
|
|
|
* Application entry point.
|
2010-07-03 07:53:04 +00:00
|
|
|
*/
|
2010-12-21 10:30:39 +00:00
|
|
|
int main(void) {
|
2010-07-03 07:53:04 +00:00
|
|
|
static const evhandler_t evhndl[] = {
|
|
|
|
InsertHandler,
|
|
|
|
RemoveHandler
|
|
|
|
};
|
|
|
|
Thread *shelltp = NULL;
|
|
|
|
struct EventListener el0, el1;
|
|
|
|
|
2010-12-19 10:25:31 +00:00
|
|
|
/*
|
|
|
|
* 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();
|
|
|
|
|
2010-07-03 07:53:04 +00:00
|
|
|
/*
|
|
|
|
* Activates the serial driver 1 using the driver default configuration.
|
|
|
|
*/
|
|
|
|
sdStart(&SD1, NULL);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Shell manager initialization.
|
|
|
|
*/
|
|
|
|
shellInit();
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Initializes the MMC driver to work with SPI.
|
|
|
|
*/
|
|
|
|
palSetPadMode(IOPORT1, PIOA_CS_MMC, PAL_MODE_OUTPUT_PUSHPULL);
|
|
|
|
palSetPad(IOPORT1, PIOA_CS_MMC);
|
2010-10-23 11:51:19 +00:00
|
|
|
mmcObjectInit(&MMCD1, &SPID1,
|
2010-07-03 07:53:04 +00:00
|
|
|
&ls_spicfg, &hs_spicfg,
|
|
|
|
mmc_is_protected, mmc_is_inserted);
|
2011-01-09 10:10:39 +00:00
|
|
|
mmcStart(&MMCD1, NULL);
|
2010-07-03 07:53:04 +00:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Creates the blinker threads.
|
|
|
|
*/
|
|
|
|
chThdCreateStatic(waThread1, sizeof(waThread1), NORMALPRIO, Thread1, NULL);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Normal main() thread activity, in this demo it does nothing except
|
|
|
|
* sleeping in a loop and listen for events.
|
|
|
|
*/
|
2011-06-28 06:54:35 +00:00
|
|
|
chEvtRegister(&MMCD1.inserted_event, &el0, 0);
|
|
|
|
chEvtRegister(&MMCD1.removed_event, &el1, 1);
|
2010-07-03 07:53:04 +00:00
|
|
|
while (TRUE) {
|
|
|
|
if (!shelltp)
|
|
|
|
shelltp = shellCreate(&shell_cfg1, SHELL_WA_SIZE, NORMALPRIO);
|
|
|
|
else if (chThdTerminated(shelltp)) {
|
|
|
|
chThdRelease(shelltp); /* Recovers memory of the previous shell. */
|
|
|
|
shelltp = NULL; /* Triggers spawning of a new shell. */
|
|
|
|
}
|
|
|
|
chEvtDispatch(evhndl, chEvtWaitOne(ALL_EVENTS));
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|