#include "../include/pad.h"

void get_digital_direction( Controller_Data *c, int buttondata ) // get analog stick values
{
int i;
    i = ~(buttondata);
    if( i & 0x80 )
        c->xpos -= 1;
    if( i & 0x20 )
        c->xpos += 1;
    if( i & 0x40 )
        c->ypos += 1;
    if( i & 0x10 )
        c->ypos -= 1;
}
void read_controller( Controller_Data *c, unsigned char *buf, int port )  // get the raw values from controller
{
    register int mouse_x, mouse_y, x;
    register Gun_Position *g;
    c->status =  buf[0];    // Copy over raw controller data
    c->type =    buf[1];
    c->button1 = buf[2];
    c->button2 = buf[3];
    c->analog0 = buf[4];
    c->analog1 = buf[5];
    c->analog2 = buf[6];
    c->analog3 = buf[7];
    if( buf[0] == 0xff )    // If controller returns BAD status then bail on it.
    {
        c->type = 0;
        return;
    }
    // Look at the controller type code & process controller data as indicated
    switch( c->type )
    {
        case 0x12:      // Sony Mouse
            mouse_x = buf[4];
            mouse_y = buf[5];
            if( mouse_x & 0x80 )
                mouse_x |= 0xffffff80;
            if( mouse_y & 0x80 )
                mouse_y |= 0xffffff80;
            c->xpos += mouse_x;
            c->ypos += mouse_y;
            break;
        case 0x23:      // Namco negCon
                        // Steering wheel
                        // Sankyo Pachinko controler
            get_digital_direction( c, buf[2] );
            break;
        case 0x53:      // Analog 2-stick
            get_digital_direction( c, buf[2] );
            break;
        case 0x41:      // Standard Sony PAD controller
            get_digital_direction( c, buf[2] );
            break;
        default:        // If don't know what it is, treat it like standard controller
            get_digital_direction( c, buf[2] );
            break;
    }
}