PS2 - PS/2 | Mbed

Users » shintamainjp » Code » PS2

PS/2

Dependents: Synth Lab3Translator PS2_Keyboard CLI ... more

PS2KB_INIT.cpp@1:823c2798e398, 2010-09-29 (annotated)

Committer:: shintamainjp
Date:: Wed Sep 29 14:11:44 2010 +0000
Revision:: 1:823c2798e398
Child:: 2:a57bbbec16b1

Who changed what in which revision?

User	Revision	Line number	New contents of line
shintamainjp	1:823c2798e398	1	/**
shintamainjp	1:823c2798e398	2	* PS/2 keyboard interface control class (Version 0.0.1)
shintamainjp	1:823c2798e398	3	*
shintamainjp	1:823c2798e398	4	* Copyright (C) 2010 Shinichiro Nakamura (CuBeatSystems)
shintamainjp	1:823c2798e398	5	* http://shinta.main.jp/
shintamainjp	1:823c2798e398	6	*/
shintamainjp	1:823c2798e398	7	#include "PS2KB_INIT.h"
shintamainjp	1:823c2798e398	8
shintamainjp	1:823c2798e398	9	/**
shintamainjp	1:823c2798e398	10	* Create.
shintamainjp	1:823c2798e398	11	*/
shintamainjp	1:823c2798e398	12	PS2KB_INIT::PS2KB_INIT(PinName clk_pin, PinName dat_pin)
shintamainjp	1:823c2798e398	13	: clk(clk_pin), dat(dat_pin) {
shintamainjp	1:823c2798e398	14	clk.input();
shintamainjp	1:823c2798e398	15	dat.input();
shintamainjp	1:823c2798e398	16	clk.write(1);
shintamainjp	1:823c2798e398	17	dat.write(1);
shintamainjp	1:823c2798e398	18
shintamainjp	1:823c2798e398	19	char txdat[12] = "\xFF\xED\x07\xF2\xED\x00\xF3\x20\xF3\x00\xF4";
shintamainjp	1:823c2798e398	20	const int n = sizeof(txdat);
shintamainjp	1:823c2798e398	21	int txerrcnt = 0;
shintamainjp	1:823c2798e398	22	int rxerrcnt = 0;
shintamainjp	1:823c2798e398	23	for (int i = 0; i < n; i++) {
shintamainjp	1:823c2798e398	24	if (send(txdat[i]) != 0) {
shintamainjp	1:823c2798e398	25	txerrcnt++;
shintamainjp	1:823c2798e398	26	}
shintamainjp	1:823c2798e398	27	if (recv() < 0) {
shintamainjp	1:823c2798e398	28	rxerrcnt++;
shintamainjp	1:823c2798e398	29	}
shintamainjp	1:823c2798e398	30	if (txdat[i] == 0xF2) {
shintamainjp	1:823c2798e398	31	if (recv() < 0) {
shintamainjp	1:823c2798e398	32	rxerrcnt++;
shintamainjp	1:823c2798e398	33	}
shintamainjp	1:823c2798e398	34	}
shintamainjp	1:823c2798e398	35	}
shintamainjp	1:823c2798e398	36
shintamainjp	1:823c2798e398	37	if (txerrcnt > 0) {
shintamainjp	1:823c2798e398	38	// printf("TX %d errors occured.\n", txerrcnt);
shintamainjp	1:823c2798e398	39	}
shintamainjp	1:823c2798e398	40	if (rxerrcnt > 0) {
shintamainjp	1:823c2798e398	41	// printf("RX %d errors occured.\n", rxerrcnt);
shintamainjp	1:823c2798e398	42	}
shintamainjp	1:823c2798e398	43	}
shintamainjp	1:823c2798e398	44
shintamainjp	1:823c2798e398	45	/**
shintamainjp	1:823c2798e398	46	* Destroy.
shintamainjp	1:823c2798e398	47	*/
shintamainjp	1:823c2798e398	48	PS2KB_INIT::~PS2KB_INIT() {
shintamainjp	1:823c2798e398	49	}
shintamainjp	1:823c2798e398	50
shintamainjp	1:823c2798e398	51	/**
shintamainjp	1:823c2798e398	52	* Send a byte data.
shintamainjp	1:823c2798e398	53	*
shintamainjp	1:823c2798e398	54	* @param c a character.
shintamainjp	1:823c2798e398	55	*
shintamainjp	1:823c2798e398	56	* @return Negative value is a error number.
shintamainjp	1:823c2798e398	57	*/
shintamainjp	1:823c2798e398	58	int PS2KB_INIT::send(uint8_t c) {
shintamainjp	1:823c2798e398	59	clk.output();
shintamainjp	1:823c2798e398	60	dat.output();
shintamainjp	1:823c2798e398	61
shintamainjp	1:823c2798e398	62	clk.write(0);
shintamainjp	1:823c2798e398	63	wait_us(200);
shintamainjp	1:823c2798e398	64
shintamainjp	1:823c2798e398	65	dat.write(0);
shintamainjp	1:823c2798e398	66	wait_us(10);
shintamainjp	1:823c2798e398	67	clk.write(1);
shintamainjp	1:823c2798e398	68	wait_us(10);
shintamainjp	1:823c2798e398	69
shintamainjp	1:823c2798e398	70	clk.input();
shintamainjp	1:823c2798e398	71	int parcnt = 0;
shintamainjp	1:823c2798e398	72	for (int i = 0; i < 10; i++) {
shintamainjp	1:823c2798e398	73	if (!waitClockDownEdge()) {
shintamainjp	1:823c2798e398	74	return -1;
shintamainjp	1:823c2798e398	75	}
shintamainjp	1:823c2798e398	76	if ((0 <= i) && (i <= 7)) {
shintamainjp	1:823c2798e398	77	/*
shintamainjp	1:823c2798e398	78	* Data bit.
shintamainjp	1:823c2798e398	79	*/
shintamainjp	1:823c2798e398	80	if ((c & (1 << i)) == 0) {
shintamainjp	1:823c2798e398	81	dat.write(0);
shintamainjp	1:823c2798e398	82	} else {
shintamainjp	1:823c2798e398	83	dat.write(1);
shintamainjp	1:823c2798e398	84	parcnt++;
shintamainjp	1:823c2798e398	85	}
shintamainjp	1:823c2798e398	86	}
shintamainjp	1:823c2798e398	87	if (i == 8) {
shintamainjp	1:823c2798e398	88	/*
shintamainjp	1:823c2798e398	89	* Parity bit.
shintamainjp	1:823c2798e398	90	*/
shintamainjp	1:823c2798e398	91	if ((parcnt % 2) == 0) {
shintamainjp	1:823c2798e398	92	dat.write(1);
shintamainjp	1:823c2798e398	93	} else {
shintamainjp	1:823c2798e398	94	dat.write(0);
shintamainjp	1:823c2798e398	95	}
shintamainjp	1:823c2798e398	96	}
shintamainjp	1:823c2798e398	97	if (i == 9) {
shintamainjp	1:823c2798e398	98	/*
shintamainjp	1:823c2798e398	99	* Stop bit.
shintamainjp	1:823c2798e398	100	*/
shintamainjp	1:823c2798e398	101	dat.write(1);
shintamainjp	1:823c2798e398	102	}
shintamainjp	1:823c2798e398	103	}
shintamainjp	1:823c2798e398	104	dat.input();
shintamainjp	1:823c2798e398	105
shintamainjp	1:823c2798e398	106	/*
shintamainjp	1:823c2798e398	107	* Check a ACK.
shintamainjp	1:823c2798e398	108	*/
shintamainjp	1:823c2798e398	109	if (!waitClockDownEdge()) {
shintamainjp	1:823c2798e398	110	return -2;
shintamainjp	1:823c2798e398	111	}
shintamainjp	1:823c2798e398	112	if (dat.read() != 0) {
shintamainjp	1:823c2798e398	113	return -3;
shintamainjp	1:823c2798e398	114	}
shintamainjp	1:823c2798e398	115
shintamainjp	1:823c2798e398	116	if (!waitClockUpLevel()) {
shintamainjp	1:823c2798e398	117	return -4;
shintamainjp	1:823c2798e398	118	}
shintamainjp	1:823c2798e398	119
shintamainjp	1:823c2798e398	120	return 0;
shintamainjp	1:823c2798e398	121	}
shintamainjp	1:823c2798e398	122
shintamainjp	1:823c2798e398	123	/**
shintamainjp	1:823c2798e398	124	* Receive a byte data.
shintamainjp	1:823c2798e398	125	*
shintamainjp	1:823c2798e398	126	* @return return a data. Negative value is a error number.
shintamainjp	1:823c2798e398	127	*/
shintamainjp	1:823c2798e398	128	int PS2KB_INIT::recv(void) {
shintamainjp	1:823c2798e398	129	uint8_t c = 0;
shintamainjp	1:823c2798e398	130	clk.input();
shintamainjp	1:823c2798e398	131	dat.input();
shintamainjp	1:823c2798e398	132	int parcnt = 0;
shintamainjp	1:823c2798e398	133	for (int i = 0; i < 11; i++) {
shintamainjp	1:823c2798e398	134	if (!waitClockDownEdge()) {
shintamainjp	1:823c2798e398	135	return -1;
shintamainjp	1:823c2798e398	136	}
shintamainjp	1:823c2798e398	137	if (i == 0) {
shintamainjp	1:823c2798e398	138	/*
shintamainjp	1:823c2798e398	139	* Start bit.
shintamainjp	1:823c2798e398	140	*/
shintamainjp	1:823c2798e398	141	if (dat.read() != 0) {
shintamainjp	1:823c2798e398	142	return -2;
shintamainjp	1:823c2798e398	143	}
shintamainjp	1:823c2798e398	144	}
shintamainjp	1:823c2798e398	145	if ((1 <= i) && (i <= 8)) {
shintamainjp	1:823c2798e398	146	/*
shintamainjp	1:823c2798e398	147	* Data bit.
shintamainjp	1:823c2798e398	148	*/
shintamainjp	1:823c2798e398	149	if (dat.read() == 0) {
shintamainjp	1:823c2798e398	150	c &= ~(1 << (i - 1));
shintamainjp	1:823c2798e398	151	} else {
shintamainjp	1:823c2798e398	152	c \|= (1 << (i - 1));
shintamainjp	1:823c2798e398	153	parcnt++;
shintamainjp	1:823c2798e398	154	}
shintamainjp	1:823c2798e398	155	}
shintamainjp	1:823c2798e398	156	if (i == 9) {
shintamainjp	1:823c2798e398	157	/*
shintamainjp	1:823c2798e398	158	* Parity bit.
shintamainjp	1:823c2798e398	159	*/
shintamainjp	1:823c2798e398	160	if (dat.read() == 0) {
shintamainjp	1:823c2798e398	161	if ((parcnt % 2) != 1) {
shintamainjp	1:823c2798e398	162	return -3;
shintamainjp	1:823c2798e398	163	}
shintamainjp	1:823c2798e398	164	} else {
shintamainjp	1:823c2798e398	165	if ((parcnt % 2) != 0) {
shintamainjp	1:823c2798e398	166	return -4;
shintamainjp	1:823c2798e398	167	}
shintamainjp	1:823c2798e398	168	}
shintamainjp	1:823c2798e398	169	}
shintamainjp	1:823c2798e398	170	if (i == 10) {
shintamainjp	1:823c2798e398	171	/*
shintamainjp	1:823c2798e398	172	* Stop bit.
shintamainjp	1:823c2798e398	173	*/
shintamainjp	1:823c2798e398	174	if (dat.read() != 1) {
shintamainjp	1:823c2798e398	175	return -5;
shintamainjp	1:823c2798e398	176	}
shintamainjp	1:823c2798e398	177	}
shintamainjp	1:823c2798e398	178	}
shintamainjp	1:823c2798e398	179	return (int)c;
shintamainjp	1:823c2798e398	180	}
shintamainjp	1:823c2798e398	181
shintamainjp	1:823c2798e398	182	/**
shintamainjp	1:823c2798e398	183	* Wait a clock down edge.
shintamainjp	1:823c2798e398	184	*
shintamainjp	1:823c2798e398	185	* @return true if wait done.
shintamainjp	1:823c2798e398	186	*/
shintamainjp	1:823c2798e398	187	bool PS2KB_INIT::waitClockDownEdge(void) {
shintamainjp	1:823c2798e398	188	int cnt;
shintamainjp	1:823c2798e398	189	/*
shintamainjp	1:823c2798e398	190	* Wait until clock is low.
shintamainjp	1:823c2798e398	191	*/
shintamainjp	1:823c2798e398	192	cnt = 0;
shintamainjp	1:823c2798e398	193	while (clk.read() == 0) {
shintamainjp	1:823c2798e398	194	cnt++;
shintamainjp	1:823c2798e398	195	if (MAX_RETRY < cnt) {
shintamainjp	1:823c2798e398	196	return false;
shintamainjp	1:823c2798e398	197	}
shintamainjp	1:823c2798e398	198	wait_us(1);
shintamainjp	1:823c2798e398	199	}
shintamainjp	1:823c2798e398	200	/*
shintamainjp	1:823c2798e398	201	* Wait until clock is high.
shintamainjp	1:823c2798e398	202	*/
shintamainjp	1:823c2798e398	203	cnt = 0;
shintamainjp	1:823c2798e398	204	while (clk.read() == 1) {
shintamainjp	1:823c2798e398	205	cnt++;
shintamainjp	1:823c2798e398	206	if (MAX_RETRY < cnt) {
shintamainjp	1:823c2798e398	207	return false;
shintamainjp	1:823c2798e398	208	}
shintamainjp	1:823c2798e398	209	wait_us(1);
shintamainjp	1:823c2798e398	210	}
shintamainjp	1:823c2798e398	211	return true;
shintamainjp	1:823c2798e398	212	}
shintamainjp	1:823c2798e398	213
shintamainjp	1:823c2798e398	214	/**
shintamainjp	1:823c2798e398	215	* Wait a clock up level.
shintamainjp	1:823c2798e398	216	*
shintamainjp	1:823c2798e398	217	* @return true if wait done.
shintamainjp	1:823c2798e398	218	*/
shintamainjp	1:823c2798e398	219	bool PS2KB_INIT::waitClockUpLevel(void) {
shintamainjp	1:823c2798e398	220	int cnt;
shintamainjp	1:823c2798e398	221	/*
shintamainjp	1:823c2798e398	222	* Wait until clock is low.
shintamainjp	1:823c2798e398	223	*/
shintamainjp	1:823c2798e398	224	cnt = 0;
shintamainjp	1:823c2798e398	225	while (clk.read() == 0) {
shintamainjp	1:823c2798e398	226	cnt++;
shintamainjp	1:823c2798e398	227	if (MAX_RETRY < cnt) {
shintamainjp	1:823c2798e398	228	return false;
shintamainjp	1:823c2798e398	229	}
shintamainjp	1:823c2798e398	230	wait_us(1);
shintamainjp	1:823c2798e398	231	}
shintamainjp	1:823c2798e398	232	return true;
shintamainjp	1:823c2798e398	233	}

Repository toolbox

Export to desktop IDE

Repository details

Type:	Library
Created:	31 Aug 2010
Imports:	295
Forks:	1
Commits:	3
Dependents:	10
Dependencies:	0
Followers:	9

PS2KB_INIT.cpp@1:823c2798e398, 2010-09-29 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning