Implemented basic calculation of angles from wall, made tapesensor save calibrationdata in file