finished servo library change and compass code minus RF