CPU frequency test

I added a function that detects CPU frequency :)
It works as follows:
1-Read current time strap counter.
2-Wait 1 sec.
3-Read current time strap counter again.
4-Subtract.
5-Divide by 1000000.
6-You got frequency in Mhz.