1
0
mirror of git://projects.qi-hardware.com/ben-wpan.git synced 2025-04-21 12:27:27 +03:00

tools: give the driver control over CLKM (for ATmega32U2 boards)

- include/atrf.h (atrf_set_clkm), lib/atrf.c (atrf_set_clkm): set or
  disable CLKM
- lib/driver.h (atrf_set_clkm_generic), lib/atrf.c (atrf_set_clkm_generic):
  generic function to set CLKM without restrictions
- lib/driver.h (struct atrf_driver): added driver operation "set_clkm"
  to set CLKM
- lib/atusb.c (atusb_set_clkm, atusb_driver): restrict CLKM on ATmega32U2
  boards
- atrf-txrx/atrf-txrx.c (init_txrx): use atrf_set_clkm to set CLKM
- atrf-txrx/atrf-txrx.c (init_txrx, main): pass CLKM frequency in MHz
  instead of code point
This commit is contained in:
Werner Almesberger
2011-02-10 23:11:34 -03:00
parent e73ca5fcd5
commit b0c15b7e7c
5 changed files with 111 additions and 19 deletions

View File

@@ -149,6 +149,52 @@ int atrf_test_mode(struct atrf_dsc *dsc)
}
int atrf_set_clkm_generic(
void (*reg_write)(void *dsc, uint8_t reg, uint8_t value),
void *handle, int mhz)
{
uint8_t clkm;
if (!mhz) {
reg_write(handle, REG_TRX_CTRL_0, 0); /* disable CLKM */
return 1;
}
switch (mhz) {
case 1:
clkm = CLKM_CTRL_1MHz;
break;
case 2:
clkm = CLKM_CTRL_2MHz;
break;
case 4:
clkm = CLKM_CTRL_4MHz;
break;
case 8:
clkm = CLKM_CTRL_8MHz;
break;
case 16:
clkm = CLKM_CTRL_16MHz;
break;
default:
fprintf(stderr, "unsupported CLKM frequency %d MHz\n", mhz);
return 0;
}
reg_write(handle, REG_TRX_CTRL_0,
(PAD_IO_8mA << PAD_IO_CLKM_SHIFT) | clkm);
return 1;
}
int atrf_set_clkm(struct atrf_dsc *dsc, int mhz)
{
if (dsc->driver->set_clkm)
return dsc->driver->set_clkm(dsc->handle, mhz);
else
return atrf_set_clkm_generic(dsc->driver->reg_write,
dsc->handle, mhz);
}
void atrf_reg_write(struct atrf_dsc *dsc, uint8_t reg, uint8_t value)
{
dsc->driver->reg_write(dsc->handle, reg, value);