101 lines
1.6 KiB
C
101 lines
1.6 KiB
C
#include "clock.h"
|
|
#include "uart.h"
|
|
#include <stdint.h>
|
|
|
|
// K&R inspirated
|
|
|
|
void printhex(unsigned int d)
|
|
{
|
|
char n;
|
|
for (int c = 28; c >= 0; c -= 4) {
|
|
// get highest tetrad
|
|
n = (d >> c) & 0xF;
|
|
// 0-9 => '0'-'9', 10-15 => 'A'-'F'
|
|
n += n > 9 ? 0x37 : 0x30;
|
|
putc(n);
|
|
}
|
|
}
|
|
|
|
int strlen(char s[])
|
|
{
|
|
int i = 0;
|
|
while (s[i] != '\0') {
|
|
++i;
|
|
}
|
|
return i;
|
|
}
|
|
|
|
void reverse(char s[])
|
|
{
|
|
int c, i, j;
|
|
for (i = 0, j = strlen(s) - 1; i < j; i++, j--) {
|
|
c = s[i];
|
|
s[i] = s[j];
|
|
s[j] = c;
|
|
}
|
|
}
|
|
|
|
void itoa(unsigned int n, char s[])
|
|
{
|
|
int i = 0;
|
|
do {
|
|
s[i++] = n % 10 + '0';
|
|
} while ((n /= 10) > 0);
|
|
s[i] = '\0';
|
|
reverse(s);
|
|
}
|
|
|
|
void printdec(unsigned int d)
|
|
{
|
|
char s[16];
|
|
itoa(d, s);
|
|
for (int i = 0; i < strlen(s); i++) {
|
|
putc(s[i]);
|
|
}
|
|
}
|
|
|
|
void printclock()
|
|
{
|
|
static const char *clocktxts[] = {"reserved", "EMMC", "UART", "ARM", "CORE",
|
|
"V3D", "H264", "ISP", "SDRAM", "PIXEL",
|
|
"PWM", "HEVC", "EMMC2", "M2MC", "PIXEL_BVB"};
|
|
|
|
puts("Clocks:\n");
|
|
for (int i = 1; i <= CLK_PIXEL_BVB; i++) {
|
|
puts(" ");
|
|
puts(clocktxts[i]);
|
|
puts(": ");
|
|
printdec(getclock(i, 0));
|
|
puts("/");
|
|
printdec(getclock(i, 1));
|
|
puts(" Hz\n");
|
|
}
|
|
}
|
|
|
|
int readline(char *buf, int maxlen)
|
|
{
|
|
int num = 0;
|
|
while (num < maxlen - 1) {
|
|
char c = uart_recv();
|
|
// It seems like screen sends \r when I press enter
|
|
if (c == '\n' || c == '\0' || c == '\r') {
|
|
break;
|
|
}
|
|
buf[num] = c;
|
|
num++;
|
|
}
|
|
buf[num] = '\0';
|
|
return num;
|
|
}
|
|
|
|
// Returns <0 if s1<s2, 0 if s1==s2, >0 if s1>s2
|
|
int strcmp(const char s1[], const char s2[])
|
|
{
|
|
int i;
|
|
for (i = 0; s1[i] == s2[i]; i++) {
|
|
if (s1[i] == '\0')
|
|
return 0;
|
|
}
|
|
return s1[i] - s2[i];
|
|
}
|