单片机的闭环控制，2014年电子技能大赛G提简易风洞设计

小弟我最近想试着做闭环控制系统，也就是2014年电子技能大赛G题-控制类，简易风洞设计。
风洞的功能要求：给定一高度值，单片机发出指令配合超声波返回值发送pwm信号给风机，通过控制风量达到给定的高度
设想如下：
风洞为透明的亚克力管，直径稍大于乒乓球。
底部固定一风机，在管子顶部距离3cm处固定一超声波模块。
用lcd12864或lcd1602来显示超声波的返回数值和刚开始的给定值。
通过超声波模块的返回值让单片机发送pwm信号给风机从而控制风量以达到给定高度。
芯片的话，小弟手头有stc89c52  stc12c5a60s2,
超声波的话，就是hc-sr04。
各位大神，我现在的水平就是，知道单独的模块咋用，但不知道怎么把它们结合起来用，我想这也是许多像我一样的初学者最大的困惑吧。就比如说，我会用超声波测距并用lcd1602显示，也会用pwm调速，但是我不会结合它们成为一个闭环，这是问题的关键。
如果那位大神有足够的耐心的话，不妨讲讲如何结合不同的模块实现一个功能，如果嫌讲起来费劲的话，能不能就直接发个这种程序给我---也就是2014年电子技能大赛G题控制类题的程序，真的万分感谢。