mirror of
https://gitea.osmocom.org/sim-card/simtrace2.git
synced 2026-03-22 16:28:32 +03:00
Change directory structure to align with Atmel softpack
This way we can easily check with 'diff' for differences in our code and Atmel softpack. Also, this layout is more suitable for building various different firmware images (e.g. factory-test, dfu-loader, main application) for a variety of different boards (simtrace, owhw, qmod).
This commit is contained in:
Harald Welte
203
firmware/libboard/qmod/source/i2c.c
Normal file
203
firmware/libboard/qmod/source/i2c.c
Normal file
@@ -0,0 +1,203 @@
|
||||
#include "board.h"
|
||||
#include <stdbool.h>
|
||||
|
||||
/* Low-Level I2C Routines */
|
||||
|
||||
static const Pin pin_sda = {PIO_PA30, PIOA, ID_PIOA, PIO_OUTPUT_1, PIO_OPENDRAIN };
|
||||
static const Pin pin_sda_in = {PIO_PA30, PIOA, ID_PIOA, PIO_INPUT, PIO_DEFAULT };
|
||||
static const Pin pin_scl = {PIO_PA31, PIOA, ID_PIOA, PIO_OUTPUT_1, PIO_OPENDRAIN };
|
||||
|
||||
static void i2c_delay()
|
||||
{
|
||||
volatile int v;
|
||||
int i;
|
||||
|
||||
/* 100 cycles results in SCL peak length of 44us, so it's about
|
||||
* 440ns per cycle here */
|
||||
for (i = 0; i < 14; i++) {
|
||||
v = 0;
|
||||
}
|
||||
}
|
||||
|
||||
void i2c_pin_init(void)
|
||||
{
|
||||
PIO_Configure(&pin_scl, PIO_LISTSIZE(pin_scl));
|
||||
PIO_Configure(&pin_sda, PIO_LISTSIZE(pin_sda));
|
||||
}
|
||||
|
||||
static void set_scl(void)
|
||||
{
|
||||
PIO_Set(&pin_scl);
|
||||
i2c_delay();
|
||||
}
|
||||
|
||||
static void set_sda(void)
|
||||
{
|
||||
PIO_Set(&pin_sda);
|
||||
i2c_delay();
|
||||
}
|
||||
|
||||
static void clear_scl(void)
|
||||
{
|
||||
PIO_Clear(&pin_scl);
|
||||
i2c_delay();
|
||||
}
|
||||
|
||||
static void clear_sda(void)
|
||||
{
|
||||
PIO_Clear(&pin_sda);
|
||||
i2c_delay();
|
||||
}
|
||||
|
||||
static bool read_sda(void)
|
||||
{
|
||||
bool ret;
|
||||
|
||||
PIO_Configure(&pin_sda_in, PIO_LISTSIZE(pin_sda_in));
|
||||
if (PIO_Get(&pin_sda_in))
|
||||
ret = true;
|
||||
else
|
||||
ret = false;
|
||||
PIO_Configure(&pin_sda, PIO_LISTSIZE(pin_sda));
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* Core I2C Routines */
|
||||
|
||||
static bool i2c_started = false;
|
||||
|
||||
static void i2c_start_cond(void)
|
||||
{
|
||||
if (i2c_started) {
|
||||
set_sda();
|
||||
set_scl();
|
||||
}
|
||||
|
||||
clear_sda();
|
||||
i2c_delay();
|
||||
clear_scl();
|
||||
i2c_started = true;
|
||||
}
|
||||
|
||||
static void i2c_stop_cond(void)
|
||||
{
|
||||
clear_sda();
|
||||
set_scl();
|
||||
set_sda();
|
||||
i2c_delay();
|
||||
i2c_started = false;
|
||||
}
|
||||
|
||||
static void i2c_write_bit(bool bit)
|
||||
{
|
||||
if (bit)
|
||||
set_sda();
|
||||
else
|
||||
clear_sda();
|
||||
i2c_delay(); // ?
|
||||
set_scl();
|
||||
clear_scl();
|
||||
}
|
||||
|
||||
static bool i2c_read_bit(void)
|
||||
{
|
||||
bool bit;
|
||||
|
||||
set_sda();
|
||||
set_scl();
|
||||
bit = read_sda();
|
||||
clear_scl();
|
||||
|
||||
return bit;
|
||||
}
|
||||
|
||||
bool i2c_write_byte(bool send_start, bool send_stop, uint8_t byte)
|
||||
{
|
||||
uint8_t bit;
|
||||
bool nack;
|
||||
|
||||
if (send_start)
|
||||
i2c_start_cond();
|
||||
|
||||
for (bit = 0; bit < 8; bit++) {
|
||||
i2c_write_bit((byte & 0x80) != 0);
|
||||
byte <<= 1;
|
||||
}
|
||||
|
||||
nack = i2c_read_bit();
|
||||
|
||||
if (send_stop)
|
||||
i2c_stop_cond();
|
||||
|
||||
return nack;
|
||||
}
|
||||
|
||||
uint8_t i2c_read_byte(bool nack, bool send_stop)
|
||||
{
|
||||
uint8_t byte = 0;
|
||||
uint8_t bit;
|
||||
|
||||
for (bit = 0; bit < 8; bit++) {
|
||||
byte = (byte << 1) | i2c_read_bit();
|
||||
}
|
||||
|
||||
i2c_write_bit(nack);
|
||||
|
||||
if (send_stop)
|
||||
i2c_stop_cond();
|
||||
|
||||
return byte;
|
||||
}
|
||||
|
||||
|
||||
/* EEPROM related code */
|
||||
|
||||
int eeprom_write_byte(uint8_t slave, uint8_t addr, uint8_t byte)
|
||||
{
|
||||
bool nack;
|
||||
|
||||
/* Write slave address */
|
||||
nack = i2c_write_byte(true, false, slave << 1);
|
||||
if (nack)
|
||||
goto out_stop;
|
||||
nack = i2c_write_byte(false, false, addr);
|
||||
if (nack)
|
||||
goto out_stop;
|
||||
nack = i2c_write_byte(false, true, byte);
|
||||
if (nack)
|
||||
goto out_stop;
|
||||
|
||||
out_stop:
|
||||
i2c_stop_cond();
|
||||
if (nack)
|
||||
return -1;
|
||||
else
|
||||
return 0;
|
||||
}
|
||||
|
||||
int eeprom_read_byte(uint8_t slave, uint8_t addr)
|
||||
{
|
||||
bool nack;
|
||||
|
||||
/* dummy write cycle */
|
||||
nack = i2c_write_byte(true, false, slave << 1);
|
||||
if (nack)
|
||||
goto out_stop;
|
||||
nack = i2c_write_byte(false, false, addr);
|
||||
if (nack)
|
||||
goto out_stop;
|
||||
/* Re-start with read */
|
||||
nack = i2c_write_byte(true, false, (slave << 1) | 1);
|
||||
if (nack)
|
||||
goto out_stop;
|
||||
|
||||
return i2c_read_byte(true, true);
|
||||
|
||||
out_stop:
|
||||
i2c_stop_cond();
|
||||
if (nack)
|
||||
return -1;
|
||||
else
|
||||
return 0;
|
||||
}
|
||||
80
firmware/libboard/qmod/source/wwan_led.c
Normal file
80
firmware/libboard/qmod/source/wwan_led.c
Normal file
@@ -0,0 +1,80 @@
|
||||
/* Code to read/track the status of the WWAN LEDs of attached modems
|
||||
*
|
||||
* 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(1);
|
||||
|
||||
TRACE_INFO("WWAN1 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(2);
|
||||
TRACE_INFO("WWAN2 LED %u\r\n", active);
|
||||
|
||||
/* TODO: notify host via USB */
|
||||
}
|
||||
#endif
|
||||
|
||||
/* determine if a tiven WWAN led is currently active or not */
|
||||
int wwan_led_active(int wwan)
|
||||
{
|
||||
const Pin *pin;
|
||||
int active;
|
||||
|
||||
switch (wwan) {
|
||||
#ifdef PIN_WWAN1
|
||||
case 1:
|
||||
pin = &pin_wwan1;
|
||||
break;
|
||||
#endif
|
||||
#ifdef PIN_WWAN2
|
||||
case 2:
|
||||
pin = &pin_wwan2;
|
||||
break;
|
||||
#endif
|
||||
default:
|
||||
return -1;
|
||||
}
|
||||
|
||||
active = PIO_Get(&pin_wwan1) ? 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;
|
||||
}
|
||||
76
firmware/libboard/qmod/source/wwan_perst.c
Normal file
76
firmware/libboard/qmod/source/wwan_perst.c
Normal file
@@ -0,0 +1,76 @@
|
||||
/* Code to control the PERST lines of attached modems
|
||||
*
|
||||
* 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 "wwan_perst.h"
|
||||
#include "osmocom/core/timer.h"
|
||||
|
||||
#define PERST_DURATION_MS 300
|
||||
|
||||
#ifdef PIN_PERST1
|
||||
static const Pin pin_perst1 = PIN_PERST1;
|
||||
static struct osmo_timer_list perst1_timer;
|
||||
#endif
|
||||
|
||||
#ifdef PIN_PERST2
|
||||
static const Pin pin_perst2 = PIN_PERST2;
|
||||
static struct osmo_timer_list perst2_timer;
|
||||
#endif
|
||||
|
||||
static void perst_tmr_cb(void *data)
|
||||
{
|
||||
const Pin *pin = data;
|
||||
/* release the (low-active) reset */
|
||||
PIO_Clear(pin);
|
||||
}
|
||||
|
||||
int wwan_perst_do_reset(int modem_nr)
|
||||
{
|
||||
const Pin *pin;
|
||||
struct osmo_timer_list *tmr;
|
||||
|
||||
switch (modem_nr) {
|
||||
#ifdef PIN_PERST1
|
||||
case 1:
|
||||
pin = &pin_perst1;
|
||||
tmr = &perst1_timer;
|
||||
break;
|
||||
#endif
|
||||
#ifdef PIN_PERST2
|
||||
case 2:
|
||||
pin = &pin_perst2;
|
||||
tmr = &perst2_timer;
|
||||
break;
|
||||
#endif
|
||||
default:
|
||||
return -1;
|
||||
}
|
||||
PIO_Set(pin);
|
||||
osmo_timer_schedule(tmr, PERST_DURATION_MS/1000, (PERST_DURATION_MS%1000)*1000);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int wwan_perst_init(void)
|
||||
{
|
||||
int num_perst = 0;
|
||||
#ifdef PIN_PERST1
|
||||
PIO_Configure(&pin_perst1, 1);
|
||||
perst1_timer.cb = perst_tmr_cb;
|
||||
perst1_timer.data = (void *) &pin_perst1;
|
||||
num_perst++;
|
||||
#endif
|
||||
|
||||
#ifdef PIN_PERST2
|
||||
PIO_Configure(&pin_perst2, 1);
|
||||
perst2_timer.cb = perst_tmr_cb;
|
||||
perst2_timer.data = (void *) &pin_perst2;
|
||||
num_perst++;
|
||||
#endif
|
||||
return num_perst;
|
||||
}
|
||||
Reference in New Issue
Block a user