Fixed bug in pid.py and updated wallfollow.py