Merge blargg's fix into adb.c

- <http://geekhack.org/index.php?topic=14290.msg1075201#msg1075201>
This commit is contained in:
tmk 2013-10-14 23:37:05 +09:00
parent 59ecced486
commit c18c52f551
3 changed files with 108 additions and 112 deletions

View file

@ -15,12 +15,15 @@ You should have received a copy of the GNU General Public License
along with this program. If not, see <http://www.gnu.org/licenses/>. along with this program. If not, see <http://www.gnu.org/licenses/>.
*/ */
#include "stdint.h" #include <stdint.h>
#include <util/delay.h>
#include "adb.h" #include "adb.h"
#include "led.h" #include "led.h"
void led_set(uint8_t usb_led) void led_set(uint8_t usb_led)
{ {
// need a wait to send command without miss
_delay_ms(100);
adb_host_kbd_led(~usb_led); adb_host_kbd_led(~usb_led);
} }

View file

@ -67,6 +67,13 @@ uint8_t matrix_cols(void)
void matrix_init(void) void matrix_init(void)
{ {
adb_host_init(); adb_host_init();
// wait for keyboard to boot up and receive command
_delay_ms(1000);
// Enable keyboard left/right modifier distinction
// Addr:Keyboard(0010), Cmd:Listen(10), Register3(11)
// upper byte: reserved bits 0000, device address 0010
// lower byte: device handler 00000011
adb_host_listen(0x2B,0x02,0x03);
// initialize matrix state: all keys off // initialize matrix state: all keys off
for (uint8_t i=0; i < MATRIX_ROWS; i++) matrix[i] = 0x00; for (uint8_t i=0; i < MATRIX_ROWS; i++) matrix[i] = 0x00;

View file

@ -1,5 +1,6 @@
/* /*
Copyright 2011 Jun WAKO <wakojun@gmail.com> Copyright 2011 Jun WAKO <wakojun@gmail.com>
Copyright 2013 Shay Green <gblargg@gmail.com>
This software is licensed with a Modified BSD License. This software is licensed with a Modified BSD License.
All of this is supposed to be Free Software, Open Source, DFSG-free, All of this is supposed to be Free Software, Open Source, DFSG-free,
@ -43,9 +44,11 @@ POSSIBILITY OF SUCH DAMAGE.
#include "debug.h" #include "debug.h"
static inline void data_lo(void); // GCC doesn't inline functions normally
static inline void data_hi(void); #define data_lo() (ADB_DDR |= (1<<ADB_DATA_BIT))
static inline bool data_in(void); #define data_hi() (ADB_DDR &= ~(1<<ADB_DATA_BIT))
#define data_in() (ADB_PIN & (1<<ADB_DATA_BIT))
#ifdef ADB_PSW_BIT #ifdef ADB_PSW_BIT
static inline void psw_lo(void); static inline void psw_lo(void);
static inline void psw_hi(void); static inline void psw_hi(void);
@ -56,24 +59,17 @@ static inline void attention(void);
static inline void place_bit0(void); static inline void place_bit0(void);
static inline void place_bit1(void); static inline void place_bit1(void);
static inline void send_byte(uint8_t data); static inline void send_byte(uint8_t data);
static inline bool read_bit(void); static inline uint16_t wait_data_lo(uint16_t us);
static inline uint8_t read_byte(void); static inline uint16_t wait_data_hi(uint16_t us);
static inline uint8_t wait_data_lo(uint16_t us);
static inline uint8_t wait_data_hi(uint8_t us);
void adb_host_init(void) void adb_host_init(void)
{ {
ADB_PORT &= ~(1<<ADB_DATA_BIT);
data_hi(); data_hi();
#ifdef ADB_PSW_BIT #ifdef ADB_PSW_BIT
psw_hi(); psw_hi();
#endif #endif
// Enable keyboard left/right modifier distinction
// Addr:Keyboard(0010), Cmd:Listen(10), Register3(11)
// upper byte: reserved bits 0000, device address 0010
// lower byte: device handler 00000011
adb_host_listen(0x2B,0x02,0x03);
} }
#ifdef ADB_PSW_BIT #ifdef ADB_PSW_BIT
@ -91,6 +87,41 @@ bool adb_host_psw(void)
* <http://geekhack.org/index.php?topic=14290.msg1068919#msg1068919> * <http://geekhack.org/index.php?topic=14290.msg1068919#msg1068919>
* <http://geekhack.org/index.php?topic=14290.msg1070139#msg1070139> * <http://geekhack.org/index.php?topic=14290.msg1070139#msg1070139>
*/ */
// ADB Bit Cells
//
// bit cell time: 70-130us
// low part of bit0: 60-70% of bit cell
// low part of bit1: 30-40% of bit cell
//
// bit cell time 70us 130us
// --------------------------------------------
// low part of bit0 42-49 78-91
// high part of bit0 21-28 39-52
// low part of bit1 21-28 39-52
// high part of bit1 42-49 78-91
//
//
// bit0:
// 70us bit cell:
// ____________~~~~~~
// 42-49 21-28
//
// 130us bit cell:
// ____________~~~~~~
// 78-91 39-52
//
// bit1:
// 70us bit cell:
// ______~~~~~~~~~~~~
// 21-28 42-49
//
// 130us bit cell:
// ______~~~~~~~~~~~~
// 39-52 78-91
//
// [from Apple IIgs Hardware Reference Second Edition]
uint16_t adb_host_kbd_recv(void) uint16_t adb_host_kbd_recv(void)
{ {
uint16_t data = 0; uint16_t data = 0;
@ -100,24 +131,50 @@ uint16_t adb_host_kbd_recv(void)
if (!wait_data_lo(500)) { // Tlt/Stop to Start(140-260us) if (!wait_data_lo(500)) { // Tlt/Stop to Start(140-260us)
return 0; // No data to send return 0; // No data to send
} }
if (!read_bit()) { // Startbit(1)
// Service Request
dprintf("Startbit ERROR\n");
return -2;
}
// ad hoc fix: without block inerrupt read wrong bit occasionally and get keys stuck // ad hoc fix: without block inerrupt read wrong bit occasionally and get keys stuck
cli(); // TODO: is this needed anymore with improved timing?
data = read_byte(); //cli();
data = (data<<8) | read_byte(); uint8_t n = 17; // start bit + 16 data bits
uint8_t stop = read_bit(); // Stopbit(0) do {
sei(); uint8_t lo = (uint8_t) wait_data_hi(130);
if (!lo)
goto error;
if (stop) { uint8_t hi = (uint8_t) wait_data_lo(lo);
if (!hi)
goto error;
hi = lo - hi;
lo = 130 - lo;
data <<= 1;
if (lo < hi) {
data |= 1;
}
else if (n == 17) {
// Service Request
dprintf("Startbit ERROR\n");
sei();
return -2;
}
}
while ( --n );
// Stop bit can't be checked normally since it could have service request lenghtening
// and its high state never goes low.
if (!wait_data_hi(351) || wait_data_lo(91)) {
dprintf("Stopbit ERROR\n"); dprintf("Stopbit ERROR\n");
sei();
return -3; return -3;
} }
sei();
return data; return data;
error:
dprintf("Bit ERROR\n");
sei();
return -4;
} }
void adb_host_listen(uint8_t cmd, uint8_t data_h, uint8_t data_l) void adb_host_listen(uint8_t cmd, uint8_t data_h, uint8_t data_l)
@ -142,23 +199,6 @@ void adb_host_kbd_led(uint8_t led)
} }
static inline void data_lo()
{
ADB_DDR |= (1<<ADB_DATA_BIT);
ADB_PORT &= ~(1<<ADB_DATA_BIT);
}
static inline void data_hi()
{
ADB_PORT |= (1<<ADB_DATA_BIT);
ADB_DDR &= ~(1<<ADB_DATA_BIT);
}
static inline bool data_in()
{
ADB_PORT |= (1<<ADB_DATA_BIT);
ADB_DDR &= ~(1<<ADB_DATA_BIT);
return ADB_PIN&(1<<ADB_DATA_BIT);
}
#ifdef ADB_PSW_BIT #ifdef ADB_PSW_BIT
static inline void psw_lo() static inline void psw_lo()
{ {
@ -181,7 +221,7 @@ static inline bool psw_in()
static inline void attention(void) static inline void attention(void)
{ {
data_lo(); data_lo();
_delay_us(700); _delay_us(800-35); // bit1 holds lo for 35 more
place_bit1(); place_bit1();
} }
@ -211,81 +251,27 @@ static inline void send_byte(uint8_t data)
} }
} }
static inline bool read_bit(void) // These are carefully coded to take 6 cycles of overhead.
// inline asm approach became too convoluted
static inline uint16_t wait_data_lo(uint16_t us)
{ {
// ADB Bit Cells do {
// if ( !data_in() )
// bit cell time: 70-130us break;
// low part of bit0: 60-70% of bit cell _delay_us(1 - (6 * 1000000.0 / F_CPU));
// low part of bit1: 30-40% of bit cell
//
// bit cell time 70us 130us
// --------------------------------------------
// low part of bit0 42-49 78-91
// high part of bit0 21-28 39-52
// low part of bit1 21-28 39-52
// high part of bit1 42-49 78-91
//
//
// bit0:
// 70us bit cell:
// ____________~~~~~~
// 42-49 21-28
//
// 130us bit cell:
// ____________~~~~~~
// 78-91 39-52
//
// bit1:
// 70us bit cell:
// ______~~~~~~~~~~~~
// 21-28 42-49
//
// 130us bit cell:
// ______~~~~~~~~~~~~
// 39-52 78-91
//
// read:
// ________|~~~~~~~~~
// 55us
// Read data line after 55us. If data line is low/high then bit is 0/1.
// This method might not work at <90us bit cell time.
//
// [from Apple IIgs Hardware Reference Second Edition]
bool bit;
wait_data_lo(75); // wait the start of bit cell at least 130ms(55+0+75)
_delay_us(55);
bit = data_in();
wait_data_hi(36); // wait high part of bit cell at least 91ms(55+36)
return bit;
}
static inline uint8_t read_byte(void)
{
uint8_t data = 0;
for (int i = 0; i < 8; i++) {
data <<= 1;
if (read_bit())
data = data | 1;
}
return data;
}
static inline uint8_t wait_data_lo(uint16_t us)
{
while (data_in() && us) {
_delay_us(1);
us--;
} }
while ( --us );
return us; return us;
} }
static inline uint8_t wait_data_hi(uint8_t us) static inline uint16_t wait_data_hi(uint16_t us)
{ {
while (!data_in() && us) { do {
_delay_us(1); if ( data_in() )
us--; break;
_delay_us(1 - (6 * 1000000.0 / F_CPU));
} }
while ( --us );
return us; return us;
} }