mirror of
https://gitea.osmocom.org/sim-card/simtrace2.git
synced 2026-03-22 08:18:32 +03:00
introduce support for new ngff_cardem board
This adds support for the new ngff_cardem board, a board that basically combines a ngff breakout board with a built-in SIMtrace2. Cardem works, but depending on the modem it might need a adjusted ATR to ensure a lower baud rate is used by the modem, high rates might lead to weird power cycling of the card after a few transfers. Trace was also tested and appears to work as expected. Change-Id: Ia96124fbe8a752c98e7fd4096d542a3b2b9bc255
This commit is contained in:
Harald Welte
159
firmware/libboard/ngff_cardem/source/board_ngff_cardem.c
Normal file
159
firmware/libboard/ngff_cardem/source/board_ngff_cardem.c
Normal file
@@ -0,0 +1,159 @@
|
||||
/* sysmocom ngff-cardem application code
|
||||
*
|
||||
* (C) 2021 Harald Welte <laforge@osmocom.org>
|
||||
*
|
||||
* This program 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 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program 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, write to the Free Software
|
||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA
|
||||
*/
|
||||
#include "board.h"
|
||||
#include "simtrace.h"
|
||||
#include "utils.h"
|
||||
#include "led.h"
|
||||
#include "wwan_led.h"
|
||||
#include "wwan_perst.h"
|
||||
#include "sim_switch.h"
|
||||
#include "boardver_adc.h"
|
||||
#include "card_pres.h"
|
||||
#include <osmocom/core/timer.h>
|
||||
#include "usb_buf.h"
|
||||
|
||||
/* array of generated USB Strings */
|
||||
extern unsigned char *usb_strings[];
|
||||
|
||||
/* returns '1' in case we should break any endless loop */
|
||||
void board_exec_dbg_cmd(int ch)
|
||||
{
|
||||
switch (ch) {
|
||||
case '?':
|
||||
printf("\t?\thelp\n\r");
|
||||
printf("\tR\treset SAM3\n\r");
|
||||
printf("\tl\tswitch off LED 1\n\r");
|
||||
printf("\tL\tswitch on LED 1\n\r");
|
||||
printf("\tg\tswitch off LED 2\n\r");
|
||||
printf("\tG\tswitch on LED 2\n\r");
|
||||
printf("\t1\tGenerate 1ms reset pulse on WWAN1\n\r");
|
||||
printf("\t!\tSwitch Channel A from physical -> remote\n\r");
|
||||
printf("\tt\t(pseudo)talloc report\n\r");
|
||||
break;
|
||||
case 'R':
|
||||
printf("Asking NVIC to reset us\n\r");
|
||||
USBD_Disconnect();
|
||||
NVIC_SystemReset();
|
||||
break;
|
||||
case 'l':
|
||||
led_blink(LED_GREEN, BLINK_ALWAYS_OFF);
|
||||
printf("LED 1 switched off\n\r");
|
||||
break;
|
||||
case 'L':
|
||||
led_blink(LED_GREEN, BLINK_ALWAYS_ON);
|
||||
printf("LED 1 switched on\n\r");
|
||||
break;
|
||||
case 'g':
|
||||
led_blink(LED_RED, BLINK_ALWAYS_OFF);
|
||||
printf("LED 2 switched off\n\r");
|
||||
break;
|
||||
case 'G':
|
||||
led_blink(LED_RED, BLINK_ALWAYS_ON);
|
||||
printf("LED 2 switched on\n\r");
|
||||
break;
|
||||
case '1':
|
||||
printf("Resetting Modem\n\r");
|
||||
wwan_perst_do_reset_pulse(0, 300);
|
||||
break;
|
||||
case '!':
|
||||
sim_switch_use_physical(0, 0);
|
||||
break;
|
||||
case 't':
|
||||
talloc_report(NULL, stdout);
|
||||
break;
|
||||
default:
|
||||
printf("Unknown command '%c'\n\r", ch);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
void board_main_top(void)
|
||||
{
|
||||
#ifndef APPLICATION_dfu
|
||||
usb_buf_init();
|
||||
|
||||
wwan_led_init();
|
||||
wwan_perst_init();
|
||||
sim_switch_init();
|
||||
#endif
|
||||
|
||||
/* Obtain the circuit board version (currently just prints voltage) */
|
||||
get_board_version_adc();
|
||||
#ifndef APPLICATION_dfu
|
||||
/* Initialize checking for card insert/remove events */
|
||||
card_present_init();
|
||||
#endif
|
||||
wwan_perst_set(0, 0);
|
||||
}
|
||||
|
||||
static int uart_has_loopback_jumper(void)
|
||||
{
|
||||
unsigned int i;
|
||||
const Pin uart_loopback_pins[] = {
|
||||
{PIO_PA9A_URXD0, PIOA, ID_PIOA, PIO_INPUT, PIO_DEFAULT},
|
||||
{PIO_PA10A_UTXD0, PIOA, ID_PIOA, PIO_OUTPUT_0, PIO_DEFAULT}
|
||||
};
|
||||
|
||||
/* Configure UART pins as I/O */
|
||||
PIO_Configure(uart_loopback_pins, PIO_LISTSIZE(uart_loopback_pins));
|
||||
|
||||
/* Send pattern over UART TX and check if it is received on RX
|
||||
* If the loop doesn't get interrupted, RxD always follows TxD and thus a
|
||||
* loopback jumper has been placed on RxD/TxD, and we will boot
|
||||
* into DFU unconditionally
|
||||
*/
|
||||
int has_loopback_jumper = 1;
|
||||
for (i = 0; i < 10; i++) {
|
||||
/* Set TxD high; abort if RxD doesn't go high either */
|
||||
PIO_Set(&uart_loopback_pins[1]);
|
||||
if (!PIO_Get(&uart_loopback_pins[0])) {
|
||||
has_loopback_jumper = 0;
|
||||
break;
|
||||
}
|
||||
/* Set TxD low, abort if RxD doesn't go low either */
|
||||
PIO_Clear(&uart_loopback_pins[1]);
|
||||
if (PIO_Get(&uart_loopback_pins[0])) {
|
||||
has_loopback_jumper = 0;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/* Put pins back to UART mode */
|
||||
const Pin uart_pins[] = {PINS_UART};
|
||||
PIO_Configure(uart_pins, PIO_LISTSIZE(uart_pins));
|
||||
|
||||
return has_loopback_jumper;
|
||||
}
|
||||
|
||||
int board_override_enter_dfu(void)
|
||||
{
|
||||
/* If the loopback jumper is set, we enter DFU mode */
|
||||
if (uart_has_loopback_jumper())
|
||||
return 1;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const Pin deton = {PIO_PA13, PIOA, ID_PIOA, PIO_OUTPUT_0, PIO_DEFAULT};
|
||||
static const Pin detoff = {PIO_PA13, PIOA, ID_PIOA, PIO_OUTPUT_1, PIO_DEFAULT};
|
||||
|
||||
void board_set_card_insert(struct cardem_inst *ci, bool card_insert)
|
||||
{
|
||||
PIO_Configure(card_insert ? &deton : &detoff, 1);
|
||||
}
|
||||
76
firmware/libboard/ngff_cardem/source/card_pres.c
Normal file
76
firmware/libboard/ngff_cardem/source/card_pres.c
Normal file
@@ -0,0 +1,76 @@
|
||||
/* card presence utilities
|
||||
*
|
||||
* (C) 2016-2021 by Harald Welte <hwelte@hmw-consulting.de>
|
||||
*
|
||||
* This program 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 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program 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, write to the Free Software
|
||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA
|
||||
*/
|
||||
#include <osmocom/core/timer.h>
|
||||
#include "board.h"
|
||||
#include "utils.h"
|
||||
#include "card_pres.h"
|
||||
|
||||
#define NUM_CARDPRES 1
|
||||
|
||||
#define TIMER_INTERVAL_MS 500
|
||||
|
||||
static const Pin pin_cardpres[NUM_CARDPRES] = { PIN_DET_USIM1_PRES };
|
||||
static int last_state[NUM_CARDPRES] = { -1 };
|
||||
static struct osmo_timer_list cardpres_timer;
|
||||
|
||||
/* Determine if a SIM card is present in the given slot */
|
||||
int is_card_present(int port)
|
||||
{
|
||||
const Pin *pin;
|
||||
int present;
|
||||
|
||||
if (port < 0 || port >= NUM_CARDPRES)
|
||||
return -1;
|
||||
pin = &pin_cardpres[port];
|
||||
|
||||
|
||||
/* high active here */
|
||||
present = PIO_Get(pin);
|
||||
|
||||
return present;
|
||||
}
|
||||
|
||||
static void cardpres_tmr_cb(void *data)
|
||||
{
|
||||
unsigned int i;
|
||||
|
||||
for (i = 0; i < ARRAY_SIZE(pin_cardpres); i++) {
|
||||
int state = is_card_present(i);
|
||||
if (state != last_state[i]) {
|
||||
TRACE_INFO("%u: Card Detect Status %d -> %d\r\n", i, last_state[i], state);
|
||||
/* FIXME: report to USB host */
|
||||
last_state[i] = state;
|
||||
}
|
||||
}
|
||||
|
||||
osmo_timer_schedule(&cardpres_timer, 0, TIMER_INTERVAL_MS*1000);
|
||||
}
|
||||
|
||||
int card_present_init(void)
|
||||
{
|
||||
unsigned int i;
|
||||
|
||||
PIO_Configure(pin_cardpres, ARRAY_SIZE(pin_cardpres));
|
||||
|
||||
/* start timer */
|
||||
cardpres_timer.cb = cardpres_tmr_cb;
|
||||
osmo_timer_schedule(&cardpres_timer, 0, TIMER_INTERVAL_MS*1000);
|
||||
|
||||
return 2;
|
||||
}
|
||||
81
firmware/libboard/ngff_cardem/source/sim_switch.c
Normal file
81
firmware/libboard/ngff_cardem/source/sim_switch.c
Normal file
@@ -0,0 +1,81 @@
|
||||
/* Code to switch between local (physical) and remote (emulated) SIM
|
||||
*
|
||||
* (C) 2015-2017 by Harald Welte <hwelte@hmw-consulting.de>
|
||||
*
|
||||
* This program 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 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program 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, write to the Free Software
|
||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA
|
||||
*/
|
||||
#include "board.h"
|
||||
#include "trace.h"
|
||||
#include "led.h"
|
||||
#include "sim_switch.h"
|
||||
|
||||
//uart12bus 2-20e pa20
|
||||
//uart22bus 1-20e pa28
|
||||
//usim2bus 1-10e pa0 pivot
|
||||
//sim det 2-10e pa13
|
||||
|
||||
static const Pin pins_default[] = {PINS_SIM_DEFAULT};
|
||||
static const Pin pins_cem[] = {PINS_SIM_CARDEM};
|
||||
|
||||
static int initialized = 0;
|
||||
|
||||
int sim_switch_use_physical(unsigned int nr, int physical)
|
||||
{
|
||||
const Pin pin = PIN_MODEM_EN;// PIN_N_MODEM_PWR_ON;
|
||||
enum led led;
|
||||
|
||||
if (!initialized) {
|
||||
TRACE_ERROR("Somebody forgot to call sim_switch_init()\r\n");
|
||||
sim_switch_init();
|
||||
}
|
||||
|
||||
TRACE_INFO("Modem %d: %s SIM\n\r", nr,
|
||||
physical ? "physical" : "virtual");
|
||||
|
||||
switch (nr) {
|
||||
case 0:
|
||||
led = LED_USIM1;
|
||||
break;
|
||||
|
||||
default:
|
||||
TRACE_ERROR("Invalid SIM%u\n\r", nr);
|
||||
return -1;
|
||||
}
|
||||
|
||||
if (physical) {
|
||||
TRACE_INFO("%u: Use local/physical SIM\r\n", nr);
|
||||
PIO_Configure(pins_default, PIO_LISTSIZE(pins_default));
|
||||
led_blink(led, BLINK_ALWAYS_ON);
|
||||
} else {
|
||||
TRACE_INFO("%u: Use remote/emulated SIM\r\n", nr);
|
||||
PIO_Configure(pins_cem, PIO_LISTSIZE(pins_cem));
|
||||
led_blink(led, BLINK_ALWAYS_OFF);
|
||||
}
|
||||
|
||||
/* just power cycle the modem because this circumvents weird issues with unreliable signals */
|
||||
PIO_Clear(&pin);
|
||||
mdelay(200);
|
||||
PIO_Set(&pin);
|
||||
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int sim_switch_init(void)
|
||||
{
|
||||
PIO_Configure(pins_default, PIO_LISTSIZE(pins_default));
|
||||
initialized = 1;
|
||||
return 1;
|
||||
}
|
||||
93
firmware/libboard/ngff_cardem/source/wwan_led.c
Normal file
93
firmware/libboard/ngff_cardem/source/wwan_led.c
Normal file
@@ -0,0 +1,93 @@
|
||||
/* Code to read/track the status of the WWAN LEDs of attached modems
|
||||
*
|
||||
* This program 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 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program 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, write to the Free Software
|
||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA
|
||||
*/
|
||||
/* Depending on the board this is running on, it might be possible
|
||||
* for the controller to read the status of the WWAN LED output lines of
|
||||
* the cellular modem. If the board supports this, it sets the
|
||||
* PIN_WWAN1 and/or PIN_WWAN2 defines in its board.h file.
|
||||
*/
|
||||
#include "board.h"
|
||||
#include "wwan_led.h"
|
||||
|
||||
#ifdef PIN_WWAN1
|
||||
static const Pin pin_wwan1 = PIN_WWAN1;
|
||||
|
||||
static void wwan1_irqhandler(const Pin *pPin)
|
||||
{
|
||||
int active = wwan_led_active(0);
|
||||
|
||||
TRACE_INFO("0: WWAN LED %u\r\n", active);
|
||||
|
||||
/* TODO: notify host via USB */
|
||||
}
|
||||
#endif
|
||||
|
||||
#ifdef PIN_WWAN2
|
||||
static const Pin pin_wwan2 = PIN_WWAN2;
|
||||
|
||||
static void wwan2_irqhandler(const Pin *pPin)
|
||||
{
|
||||
int active = wwan_led_active(1);
|
||||
TRACE_INFO("1: WWAN LED %u\r\n", active);
|
||||
|
||||
/* TODO: notify host via USB */
|
||||
}
|
||||
#endif
|
||||
|
||||
/* determine if a given WWAN led is currently active or not */
|
||||
int wwan_led_active(int wwan)
|
||||
{
|
||||
const Pin *pin;
|
||||
int active;
|
||||
|
||||
switch (wwan) {
|
||||
#ifdef PIN_WWAN1
|
||||
case 0:
|
||||
pin = &pin_wwan1;
|
||||
break;
|
||||
#endif
|
||||
#ifdef PIN_WWAN2
|
||||
case 1:
|
||||
pin = &pin_wwan2;
|
||||
break;
|
||||
#endif
|
||||
default:
|
||||
return -1;
|
||||
}
|
||||
|
||||
active = PIO_Get(pin) ? 0 : 1;
|
||||
return active;
|
||||
}
|
||||
|
||||
int wwan_led_init(void)
|
||||
{
|
||||
int num_leds = 0;
|
||||
|
||||
#ifdef PIN_WWAN1
|
||||
PIO_Configure(&pin_wwan1, 1);
|
||||
PIO_ConfigureIt(&pin_wwan1, wwan1_irqhandler);
|
||||
PIO_EnableIt(&pin_wwan1);
|
||||
num_leds++;
|
||||
#endif
|
||||
|
||||
#ifdef PIN_WWAN2
|
||||
PIO_Configure(&pin_wwan2, 1);
|
||||
PIO_ConfigureIt(&pin_wwan2, wwan2_irqhandler);
|
||||
PIO_EnableIt(&pin_wwan2);
|
||||
num_leds++;
|
||||
#endif
|
||||
return num_leds;
|
||||
}
|
||||
127
firmware/libboard/ngff_cardem/source/wwan_perst.c
Normal file
127
firmware/libboard/ngff_cardem/source/wwan_perst.c
Normal file
@@ -0,0 +1,127 @@
|
||||
/* Code to control the PERST lines of attached modems
|
||||
*
|
||||
* This program 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 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program 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, write to the Free Software
|
||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA
|
||||
*/
|
||||
/* Depending on the board this is running on, it might be possible
|
||||
* for the controller to set the status of the PERST input line of
|
||||
* the cellular modem. If the board supports this, it sets the
|
||||
* PIN_PERST1 and/or PIN_PERST2 defines in its board.h file.
|
||||
*/
|
||||
#include "board.h"
|
||||
#include "trace.h"
|
||||
#include "wwan_perst.h"
|
||||
#include <osmocom/core/timer.h>
|
||||
|
||||
struct wwan_perst {
|
||||
uint8_t idx;
|
||||
const Pin pin;
|
||||
struct osmo_timer_list timer;
|
||||
};
|
||||
|
||||
#ifdef PIN_PERST1
|
||||
static struct wwan_perst perst1 = {
|
||||
.idx = 0,
|
||||
.pin = PIN_PERST1,
|
||||
};
|
||||
#endif
|
||||
|
||||
#ifdef PIN_PERST2
|
||||
static struct wwan_perst perst2 = {
|
||||
.idx = 1,
|
||||
.pin = PIN_PERST2,
|
||||
};
|
||||
#endif
|
||||
|
||||
static int initialized = 0;
|
||||
|
||||
static void perst_tmr_cb(void *data)
|
||||
{
|
||||
struct wwan_perst *perst = data;
|
||||
/* release the (low-active) reset */
|
||||
TRACE_INFO("%u: De-asserting modem reset\r\n", perst->idx);
|
||||
PIO_Clear(&perst->pin);
|
||||
}
|
||||
|
||||
static struct wwan_perst *get_perst_for_modem(int modem_nr)
|
||||
{
|
||||
if (!initialized) {
|
||||
TRACE_ERROR("Somebody forgot to call wwan_perst_init()\r\n");
|
||||
wwan_perst_init();
|
||||
}
|
||||
|
||||
switch (modem_nr) {
|
||||
#ifdef PIN_PERST1
|
||||
case 0:
|
||||
return &perst1;
|
||||
#endif
|
||||
#ifdef PIN_PERST2
|
||||
case 1:
|
||||
return &perst2;
|
||||
#endif
|
||||
default:
|
||||
return NULL;
|
||||
}
|
||||
}
|
||||
|
||||
int wwan_perst_do_reset_pulse(int modem_nr, unsigned int duration_ms)
|
||||
{
|
||||
struct wwan_perst *perst = get_perst_for_modem(modem_nr);
|
||||
if (!perst)
|
||||
return -1;
|
||||
|
||||
TRACE_INFO("%u: Asserting modem reset\r\n", modem_nr);
|
||||
PIO_Set(&perst->pin);
|
||||
osmo_timer_schedule(&perst->timer, duration_ms/1000, (duration_ms%1000)*1000);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int wwan_perst_set(int modem_nr, int active)
|
||||
{
|
||||
struct wwan_perst *perst = get_perst_for_modem(modem_nr);
|
||||
if (!perst)
|
||||
return -1;
|
||||
|
||||
osmo_timer_del(&perst->timer);
|
||||
if (active) {
|
||||
TRACE_INFO("%u: Asserting modem reset\r\n", modem_nr);
|
||||
PIO_Set(&perst->pin);
|
||||
} else {
|
||||
TRACE_INFO("%u: De-asserting modem reset\r\n", modem_nr);
|
||||
PIO_Clear(&perst->pin);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int wwan_perst_init(void)
|
||||
{
|
||||
int num_perst = 0;
|
||||
#ifdef PIN_PERST1
|
||||
PIO_Configure(&perst1.pin, 1);
|
||||
perst1.timer.cb = perst_tmr_cb;
|
||||
perst1.timer.data = (void *) &perst1;
|
||||
num_perst++;
|
||||
#endif
|
||||
|
||||
#ifdef PIN_PERST2
|
||||
PIO_Configure(&perst2.pin, 1);
|
||||
perst2.timer.cb = perst_tmr_cb;
|
||||
perst2.timer.data = (void *) &perst2;
|
||||
num_perst++;
|
||||
#endif
|
||||
initialized = 1;
|
||||
return num_perst;
|
||||
}
|
||||
Reference in New Issue
Block a user