PS2 - PS/2 | Mbed

Users » shintamainjp » Code » PS2

PS/2

Dependents: Synth Lab3Translator PS2_Keyboard CLI ... more

PS2KB_INIT.cpp@2:a57bbbec16b1, 2010-09-29 (annotated)

Committer:: shintamainjp
Date:: Wed Sep 29 22:15:03 2010 +0000
Revision:: 2:a57bbbec16b1
Parent:: 1:823c2798e398

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

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@2:a57bbbec16b1, 2010-09-29 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning