SetPixel (w/ clipping) w/ 240x320 support

setPixel:
    cmp r1, #0
    bxlt lr
    cmp r1, #320
    bxge lr
    cmp r2, #0
    bxlt lr
    cmp r2, #240
    bxge lr
setPixelNoClip:
    stmfd sp!, {r0-r12}
    ldr r3, =.LCD_T
    ldrb r4, [r3]
    cmp r4, #2
    beq setPixel240x320
    cmp r4, #6
    beq setPixel240x320
setPixel320x240:
    add r0, r0, r1, lsl #1
    add r0, r0, r2, lsl #9
    add r0, r0, r2, lsl #7
    strh r11, [r0]
    b endsetpx
setPixel240x320:
    add r0, r0, r2, lsl #1
    mov r3, #480
    mla r0, r1, r3, r0
    strh r11, [r0]
endsetpx:
    ldmfd sp!, {r0-r12}
    bx lr