test code for sd card

2026-06-06 07:53:43 +08:00 · 2009-04-17 08:17:55 +00:00
parent 086c62a264
commit 045860364a
3 changed files with 239 additions and 0 deletions
@@ -0,0 +1,92 @@
+#include "std.h"
+#include "init_hw.h"
+#include "sys_time.h"
+#include "led.h"
+#include "interrupt_hw.h"
+#include "uart.h"
+
+#include "messages.h"
+#include "downlink.h"
+
+#include "datalink.h"
+#include "settings.h"
+#include "dl_protocol.h"
+
+#include "spi.h"
+#include "sd_card.h"
+
+static inline void main_init( void );
+static inline void main_periodic_task( void );
+static inline void main_event_task( void );
+
+
+uint8_t dl_buffer[MSG_SIZE]  __attribute__ ((aligned));
+bool_t dl_msg_available;
+uint16_t datalink_time;
+
+int main( void ) {
+  main_init();
+  while(1) {
+    if (sys_time_periodic())
+      main_periodic_task();
+    main_event_task( );
+  }
+  return 0;
+}
+
+static inline void main_init( void ) {
+  hw_init();
+  sys_time_init();
+  led_init();
+  Uart0Init();
+
+  spi_init();
+  sd_card_init();
+
+  int_enable();
+}
+
+static inline void main_periodic_task( void ) {
+  LED_TOGGLE(1);
+  //DOWNLINK_SEND_DEBUG(3,buf_input);
+}
+
+static inline void main_event_task( void ) {
+  DatalinkEvent();
+
+  // spi event
+  if (spi_message_received) {
+    /* Got a message on SPI. */
+    spi_message_received = FALSE;
+    sd_card_event();
+  }
+
+}
+
+
+#define IdOfMsg(x) (x[1])
+
+void dl_parse_msg(void) {
+
+  LED_TOGGLE(1);
+
+  uint8_t msg_id = IdOfMsg(dl_buffer);
+  switch (msg_id) {
+  
+  case  DL_PING: {
+    DOWNLINK_SEND_PONG();
+    break;
+  }
+    
+  case DL_SETTING : {
+    uint8_t i = DL_SETTING_index(dl_buffer);
+    float var = DL_SETTING_value(dl_buffer);
+    DlSetting(i, var);
+    DOWNLINK_SEND_DL_VALUE(&i, &var);
+    break;
+  }
+
+  }
+}
+
+
@@ -0,0 +1,107 @@
+/*
+ * $Id: wt_baro.c 2752 2008-10-09 07:51:24Z gautier $
+ *  
+ * Copyright (C) 2007  ENAC
+ *
+ * This file is part of paparazzi.
+ *
+ * paparazzi 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 2, or (at your option)
+ * any later version.
+ *
+ * paparazzi 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 paparazzi; see the file COPYING.  If not, write to
+ * the Free Software Foundation, 59 Temple Place - Suite 330,
+ * Boston, MA 02111-1307, USA. 
+ *
+ */
+
+/** \file 
+ *  \brief
+ *
+ */
+
+#include "sd_card.h"
+#include "spi.h"
+
+bool_t sd_card_available;
+
+static bool_t status_read_data;
+
+#define CMD_INIT_1      0x24 // set chanel AIN1/AIN2 and next operation on filter high
+#define CMD_INIT_2      0xCF // set unipolar mode, 24 bits, no boost, filter high
+#define CMD_INIT_3      0x34 // set chanel AIN1/AIN2 and next operation on filter low
+#define CMD_INIT_4      0x00 // set low filter
+#define CMD_INIT_5      0x14 // set chanel AIN1/AIN2 and next operation on mode register
+#define CMD_INIT_6      0x20 // set gain to 1, burnout current off, no filter sync, self calibration
+#define CMD_MEASUREMENT 0x54 // set chanel AIN1/AIN2 and next operation on data register
+
+
+uint8_t buf_input[3];
+uint8_t buf_output[3];
+
+
+static void send1_on_spi(uint8_t d) {
+  buf_output[0] = d;
+  spi_buffer_length = 1;
+
+  spi_buffer_input = (uint8_t*)&buf_input;
+  spi_buffer_output = (uint8_t*)&buf_output;
+  SpiStart();
+}
+
+
+void sd_card_init( void ) {
+
+  send1_on_spi(CMD_INIT_1);
+  send1_on_spi(CMD_INIT_2);
+  send1_on_spi(CMD_INIT_3);
+  send1_on_spi(CMD_INIT_4);
+  send1_on_spi(CMD_INIT_5);
+  send1_on_spi(CMD_INIT_6);
+
+  status_read_data = FALSE;
+  sd_card_available = FALSE;
+
+}
+
+void sd_card_periodic(void) {
+  if (!SpiCheckAvailable()) {
+    SpiOverRun();
+    return;
+  }
+
+  if (status_read_data) {
+    buf_output[0] = buf_output[1] = buf_output[2] = 0;
+    spi_buffer_length = 3;
+  }
+  else {
+    buf_output[0] = CMD_MEASUREMENT;
+    spi_buffer_length = 1;
+  }
+
+  spi_buffer_input = (uint8_t*)&buf_input;
+  spi_buffer_output = (uint8_t*)&buf_output;
+  //if (status_read_data)
+  //  SpiSetCPHA();
+  //else
+  //  SpiClrCPHA();
+  SpiStart();
+}
+
+/* Handle the SPI message, i.e. store the received values in variables */
+void sd_card_event( void ) {
+
+  if (status_read_data) {
+  } /* else nothing to read */
+
+  status_read_data = !status_read_data;
+
+}
+
@@ -0,0 +1,40 @@
+/*
+ * $Id: wt_baro.h 2752 2008-10-09 07:51:24Z gautier $
+ *  
+ * Copyright (C) 2007  ENAC
+ *
+ * This file is part of paparazzi.
+ *
+ * paparazzi 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 2, or (at your option)
+ * any later version.
+ *
+ * paparazzi 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 paparazzi; see the file COPYING.  If not, write to
+ * the Free Software Foundation, 59 Temple Place - Suite 330,
+ * Boston, MA 02111-1307, USA. 
+ *
+ */
+
+/** \file 
+ *  \brief
+ *
+ */
+
+#include "std.h"
+
+extern uint8_t buf_input[3];
+extern uint8_t buf_output[3];
+
+extern bool_t sd_card_available;
+
+extern void sd_card_init(void);
+extern void sd_card_periodic(void);
+extern void sd_card_event(void);
+