Fix screen rotation bugs in display, optimize it

Signed-off-by: Irmo van den Berge <bergerkiller@gmail.com>