Update draw.cpp

More speedups