2014.3.11晚

删除速度闭环，重新整定直立参数，p=15，d=0.15，基本不加速