求大神们帮忙编写一个程序，毕业设计用的。万分感谢。。

电路图基本就是这个样子了。这个图不是自己画的，是借鉴另一位大神的，这个好像不能测周期，频率。。。毕业设计给了个数字式相位差计的题目，单片机接触的不多，不是很懂。。。就这个图的话请大神们帮忙解决两个问题：1.按电路图实现相位差检测的话程序怎么编写。2.如果要测频率的话，初步想法是在电压比较器后和最后的电路后加多路选择器一个用来测频率一个用来测相位，需要时，用单片机选择就行。最后单片机的输入都在P3.2 和P3.3口 。如果这样的话方案可不可行？可行的话，选择器型号要怎么选择？程序又要怎么编写呢？