PS2 - PS/2 | Mbed

Users » shintamainjp » Code » PS2

PS/2

Dependents: Synth Lab3Translator PS2_Keyboard CLI ... more

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

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

PS2MS_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