rpitx/librpitx
1
0
Fork 0
Code Issues Pull requests Packages Projects Releases Wiki Activity

Add gpio destructor

Browse source
This commit is contained in:
F5OEO 2018-11-23 11:24:21 +00:00
parent 17748b0b0e
commit 2ca0ed14a5
3 changed files with 14 additions and 11 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

16
src/gpio.cpp
View file

@ -29,13 +29,15 @@ gpio::gpio(uint32_t base, uint32_t len)
{
gpioreg = (uint32_t *)mapmem(base, len);
/*int mhandle=mbox_open();
get_clocks(mhandle);
mbox_close(mhandle);
*/
gpiolen=len;
}
gpio::~gpio()
{
if(gpioreg!=NULL)
unmapmem((void*)gpioreg,gpiolen);
}
uint32_t gpio::GetPeripheralBase()
{
RASPBERRY_PI_INFO_T info;
@ -70,7 +72,7 @@ clkgpio::clkgpio() : gpio(GetPeripheralBase() + CLK_BASE, CLK_LEN)
clkgpio::~clkgpio()
{
gpioreg[GPCLK_CNTL] = 0x5A000000 | (Mash << 9) | pllnumber | (0 << 4); //4 is START CLK
gpioreg[GPCLK_CNTL_2] = 0x5A000000 | (Mash << 9) | pllnumber | (0 << 4); //4 is START CLK
//gpioreg[GPCLK_CNTL_2] = 0x5A000000 | (Mash << 9) | pllnumber | (0 << 4); //4 is START CLK
usleep(100);
}
@ -116,7 +118,7 @@ uint64_t clkgpio::GetPllFrequency(int PllNo)
Freq = XOSC_FREQUENCY * ((uint64_t)gpioreg[PLLH_CTRL] & 0x3ff) + XOSC_FREQUENCY * (uint64_t)gpioreg[PLLH_FRAC] / (1 << 20);
break;
}
fprintf(stderr, "Freq = %lu\n", Freq);
fprintf(stderr, "Freq = %llu\n", Freq);
return Freq;
}

7
src/gpio.h
View file

@ -1,7 +1,7 @@
#ifndef DEF_GPIO
#define DEF_GPIO
#include "stdint.h"
#include <cstdio>
@ -9,9 +9,10 @@ class gpio
{
public:
volatile uint32_t *gpioreg;
volatile uint32_t *gpioreg=NULL;
uint32_t gpiolen;
gpio(uint32_t base, uint32_t len);
~gpio();
uint32_t GetPeripheralBase();
};

2
src/mailbox.c
View file

@ -74,7 +74,7 @@ void *unmapmem(void *addr, unsigned size)
{
int s = munmap(addr, size);
if (s != 0) {
printf("munmap error %d\n", s);
fprintf(stderr,"munmap error %d\n", s);
exit (-1);
}