求教如何把超声波传感器和直流减速电机的代码揉到一起

想做一个传感装置，当物体靠近时电机开始运转，编了好久都没成功，求大神教我码代码:'(

程序结构类似下面的，下面这个是数字量的，就靠近和不靠近两个状态。
if 靠近
then 电机转动
else 电机停止

当然如果你要再先进些，可以加入距离x，就是模拟量的，
if 靠近距离≤X
then 电机转动
else 电机停止

基本上就是这样写的，有什么不清楚，可以看下造否里面的样例哦。

电机样咧和超声波样咧给出来啊。

用的是什么模块