1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
|
#include "stdio.hpp"
#include "drivers/memtext.hpp"
#include "math.hpp"
#include "string.hpp"
void (*__putchar)(char)=memtext_putchar;
void printf(char *str,...) {
u64 rsi,rdx,rcx,r8,r9;
u64* rbp;
asm volatile( "mov %%rsi, %0": "=m"(rsi));
asm volatile( "mov %%rdx, %0": "=m"(rdx));
asm volatile( "mov %%rcx, %0": "=m"(rcx));
asm volatile( "mov %%r8, %0": "=m"(r8));
asm volatile( "mov %%r9, %0": "=m"(r9));
asm volatile( "mov %%rbp, %0": "=m"(rbp));
// Init informations
int len=strlen(str);
int i=0; // Pointer to the current character
int p=1; // Pointer to the current parameter
while (i!=len) {
char c=str[i];
// Check if special char is comming
if(str[i]=='%'){
char c2=str[i+1];
char c3=str[i+2];
// First just consider the data as a void pointer
u64 data;
switch (p) {
case 1:
data=rsi;
break;
case 2:
data=rdx;
break;
case 3:
data=rcx;
break;
case 4:
data=r8;
break;
case 5:
data=r9;
break;
default:
data=*(rbp+2+p-6);
}
if(c2=='%'){
__putchar('%');
i++;
}
else if (c2=='d') {
int data_int=(int)data;
printi(data_int);
i++;
p++;
}
else if (c2=='s') {
print((char*)data);
i++;
p++;
}
else if (c2=='x') {
print("0x");
printh(data);
i++;
p++;
}
else if (c2=='l' && c3=='l') {
printi(data); // TODO: Print 64bit number
i+=2;
p++;
}
}
else{
__putchar(c);
}
i++;
}
}
void print(char *s){
int i=0;
while(s[i]!='\0'){
__putchar(s[i]);
i++;
}
}
void printi(int i) {
char str[50];
itoa(i, str);
print(str);
}
void printh(u64 h) {
char str[17];
itoh(h, str);
u8 i=0;
while(str[i]=='0')
i++;
print(&str[i]);
}
|
