Create cave_mapper.py

Controls servos to turn mapper horizontally, vertically and control the lidar. Doesn't have the code to read data off of the lidar screen