a* really working now. Some glitches around corners and with performance, maybe better without debug text