Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-06-02 20:28:37 +08:00
Code Issues Actions 20 Packages Projects Releases Wiki Activity

Merge branch 'master' of github.com:PX4/Firmware into tobi

Browse Source
This commit is contained in:
Lorenz Meier
2012-10-08 18:00:00 +02:00
parent dd50c88f07 4c14e4f5f1
commit 0edd4063af
1 changed files with 36 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
apps/systemcmds/bl_update/bl_update.c
+36 -1
View File
@@ -56,11 +56,16 @@
__EXPORT int bl_update_main(int argc, char *argv[]); __EXPORT int bl_update_main(int argc, char *argv[]);
static void setopt(void);
int int
bl_update_main(int argc, char *argv[]) bl_update_main(int argc, char *argv[])
{ {
if (argc != 2) if (argc != 2)
errx(1, "missing firmware filename"); errx(1, "missing firmware filename or command");
if (!strcmp(argv[1], "setopt"))
setopt();
int fd = open(argv[1], O_RDONLY); int fd = open(argv[1], O_RDONLY);
if (fd < 0) if (fd < 0)
@@ -172,3 +177,33 @@ flash_end:
free(buf); free(buf);
exit(0); exit(0);
} }
static void
setopt(void)
{
volatile uint32_t *optcr = (volatile uint32_t *)0x40023c14;
const uint16_t opt_mask = (3 << 2); /* BOR_LEV bitmask */
const uint16_t opt_bits = (0 << 2); /* BOR = 0, setting for 2.7-3.6V operation */
if ((*optcr & opt_mask) == opt_bits)
errx(0, "option bits are already set as required");
/* unlock the control register */
volatile uint32_t *optkeyr = (volatile uint32_t *)0x40023c08;
*optkeyr = 0x08192a3bU;
*optkeyr = 0x4c5d6e7fU;
if (*optcr & 1)
errx(1, "option control register unlock failed");
/* program the new option value */
*optcr = (*optcr & ~opt_mask) | opt_bits | (1 << 1);
usleep(1000);
if ((*optcr & opt_mask) == opt_bits)
errx(0, "option bits set");
errx(1, "option bits setting failed; readback 0x%04x", *optcr);
}