diff options
| author | Daniel Hellstrom <daniel@gaisler.com> | 2017-01-22 11:30:04 +0100 |
|---|---|---|
| committer | Daniel Hellstrom <daniel@gaisler.com> | 2017-03-06 07:54:55 +0100 |
| commit | 1b559e31132efcff4a4f5f0ab35c41b2b04599c1 (patch) | |
| tree | b3c2404e86429a1b416c4ba0631da1558ce1c698 | |
| parent | leon, grspw_pkt: ISR RX/TX DMA interrupt source disable configurable (diff) | |
| download | rtems-1b559e31132efcff4a4f5f0ab35c41b2b04599c1.tar.bz2 | |
leon, grspw_pkt: add missing GRSPW1 IP-core support
| -rw-r--r-- | c/src/lib/libbsp/sparc/shared/spw/grspw_pkt.c | 23 |
1 files changed, 23 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/sparc/shared/spw/grspw_pkt.c b/c/src/lib/libbsp/sparc/shared/spw/grspw_pkt.c index 6b5390fffd..aa83524e2d 100644 --- a/c/src/lib/libbsp/sparc/shared/spw/grspw_pkt.c +++ b/c/src/lib/libbsp/sparc/shared/spw/grspw_pkt.c @@ -3010,6 +3010,20 @@ void grspw_initialize_user(void *(*devfound)(int), void (*devremove)(int,void*)) } } +/* Get a value at least 6.4us in number of clock cycles */ +static unsigned int grspw1_calc_timer64(int freq_khz) +{ + unsigned int timer64 = (freq_khz * 64 + 9999) / 10000; + return timer64 & 0xfff; +} + +/* Get a value at least 850ns in number of clock cycles - 3 */ +static unsigned int grspw1_calc_discon(int freq_khz) +{ + unsigned int discon = ((freq_khz * 85 + 99999) / 100000) - 3; + return discon & 0x3ff; +} + /******************* Driver manager interface ***********************/ /* Driver prototypes */ @@ -3111,9 +3125,18 @@ static int grspw2_init3(struct drvmgr_dev *dev) priv->hwsup.strip_adr = 1; /* All GRSPW2 can strip Address */ priv->hwsup.strip_pid = 1; /* All GRSPW2 can strip PID */ } else { + unsigned int apb_hz, apb_khz; + /* Autodetect GRSPW1 features? */ priv->hwsup.strip_adr = 0; priv->hwsup.strip_pid = 0; + + drvmgr_freq_get(dev, DEV_APB_SLV, &apb_hz); + apb_khz = apb_hz / 1000; + + REG_WRITE(&priv->regs->timer, + ((grspw1_calc_discon(apb_khz) & 0x3FF) << 12) | + (grspw1_calc_timer64(apb_khz) & 0xFFF)); } /* Probe width of SpaceWire Interrupt ISR timers. All have the same |