Lines Matching defs:kcs_bmc
17 #include "kcs_bmc.h"
48 static inline u8 read_data(struct kcs_bmc *kcs_bmc)
50 return kcs_bmc->io_inputb(kcs_bmc, kcs_bmc->ioreg.idr);
53 static inline void write_data(struct kcs_bmc *kcs_bmc, u8 data)
55 kcs_bmc->io_outputb(kcs_bmc, kcs_bmc->ioreg.odr, data);
58 static inline u8 read_status(struct kcs_bmc *kcs_bmc)
60 return kcs_bmc->io_inputb(kcs_bmc, kcs_bmc->ioreg.str);
63 static inline void write_status(struct kcs_bmc *kcs_bmc, u8 data)
65 kcs_bmc->io_outputb(kcs_bmc, kcs_bmc->ioreg.str, data);
68 static void update_status_bits(struct kcs_bmc *kcs_bmc, u8 mask, u8 val)
70 u8 tmp = read_status(kcs_bmc);
75 write_status(kcs_bmc, tmp);
78 static inline void set_state(struct kcs_bmc *kcs_bmc, u8 state)
80 update_status_bits(kcs_bmc, KCS_STATUS_STATE_MASK,
84 static void kcs_force_abort(struct kcs_bmc *kcs_bmc)
86 set_state(kcs_bmc, ERROR_STATE);
87 read_data(kcs_bmc);
88 write_data(kcs_bmc, KCS_ZERO_DATA);
90 kcs_bmc->phase = KCS_PHASE_ERROR;
91 kcs_bmc->data_in_avail = false;
92 kcs_bmc->data_in_idx = 0;
95 static void kcs_bmc_handle_data(struct kcs_bmc *kcs_bmc)
99 switch (kcs_bmc->phase) {
101 kcs_bmc->phase = KCS_PHASE_WRITE_DATA;
105 if (kcs_bmc->data_in_idx < KCS_MSG_BUFSIZ) {
106 set_state(kcs_bmc, WRITE_STATE);
107 write_data(kcs_bmc, KCS_ZERO_DATA);
108 kcs_bmc->data_in[kcs_bmc->data_in_idx++] =
109 read_data(kcs_bmc);
111 kcs_force_abort(kcs_bmc);
112 kcs_bmc->error = KCS_LENGTH_ERROR;
117 if (kcs_bmc->data_in_idx < KCS_MSG_BUFSIZ) {
118 set_state(kcs_bmc, READ_STATE);
119 kcs_bmc->data_in[kcs_bmc->data_in_idx++] =
120 read_data(kcs_bmc);
121 kcs_bmc->phase = KCS_PHASE_WRITE_DONE;
122 kcs_bmc->data_in_avail = true;
123 wake_up_interruptible(&kcs_bmc->queue);
125 kcs_force_abort(kcs_bmc);
126 kcs_bmc->error = KCS_LENGTH_ERROR;
131 if (kcs_bmc->data_out_idx == kcs_bmc->data_out_len)
132 set_state(kcs_bmc, IDLE_STATE);
134 data = read_data(kcs_bmc);
136 set_state(kcs_bmc, ERROR_STATE);
137 write_data(kcs_bmc, KCS_ZERO_DATA);
141 if (kcs_bmc->data_out_idx == kcs_bmc->data_out_len) {
142 write_data(kcs_bmc, KCS_ZERO_DATA);
143 kcs_bmc->phase = KCS_PHASE_IDLE;
147 write_data(kcs_bmc,
148 kcs_bmc->data_out[kcs_bmc->data_out_idx++]);
152 set_state(kcs_bmc, READ_STATE);
153 read_data(kcs_bmc);
154 write_data(kcs_bmc, kcs_bmc->error);
155 kcs_bmc->phase = KCS_PHASE_ABORT_ERROR2;
159 set_state(kcs_bmc, IDLE_STATE);
160 read_data(kcs_bmc);
161 write_data(kcs_bmc, KCS_ZERO_DATA);
162 kcs_bmc->phase = KCS_PHASE_IDLE;
166 kcs_force_abort(kcs_bmc);
171 static void kcs_bmc_handle_cmd(struct kcs_bmc *kcs_bmc)
175 set_state(kcs_bmc, WRITE_STATE);
176 write_data(kcs_bmc, KCS_ZERO_DATA);
178 cmd = read_data(kcs_bmc);
181 kcs_bmc->phase = KCS_PHASE_WRITE_START;
182 kcs_bmc->error = KCS_NO_ERROR;
183 kcs_bmc->data_in_avail = false;
184 kcs_bmc->data_in_idx = 0;
188 if (kcs_bmc->phase != KCS_PHASE_WRITE_DATA) {
189 kcs_force_abort(kcs_bmc);
193 kcs_bmc->phase = KCS_PHASE_WRITE_END_CMD;
197 if (kcs_bmc->error == KCS_NO_ERROR)
198 kcs_bmc->error = KCS_ABORTED_BY_COMMAND;
200 kcs_bmc->phase = KCS_PHASE_ABORT_ERROR1;
201 kcs_bmc->data_in_avail = false;
202 kcs_bmc->data_in_idx = 0;
206 kcs_force_abort(kcs_bmc);
207 kcs_bmc->error = KCS_ILLEGAL_CONTROL_CODE;
212 int kcs_bmc_handle_event(struct kcs_bmc *kcs_bmc)
218 spin_lock_irqsave(&kcs_bmc->lock, flags);
220 status = read_status(kcs_bmc);
222 if (!kcs_bmc->running)
223 kcs_force_abort(kcs_bmc);
225 kcs_bmc_handle_cmd(kcs_bmc);
227 kcs_bmc_handle_data(kcs_bmc);
232 spin_unlock_irqrestore(&kcs_bmc->lock, flags);
238 static inline struct kcs_bmc *to_kcs_bmc(struct file *filp)
240 return container_of(filp->private_data, struct kcs_bmc, miscdev);
245 struct kcs_bmc *kcs_bmc = to_kcs_bmc(filp);
248 spin_lock_irq(&kcs_bmc->lock);
249 if (!kcs_bmc->running)
250 kcs_bmc->running = 1;
253 spin_unlock_irq(&kcs_bmc->lock);
260 struct kcs_bmc *kcs_bmc = to_kcs_bmc(filp);
263 poll_wait(filp, &kcs_bmc->queue, wait);
265 spin_lock_irq(&kcs_bmc->lock);
266 if (kcs_bmc->data_in_avail)
268 spin_unlock_irq(&kcs_bmc->lock);
276 struct kcs_bmc *kcs_bmc = to_kcs_bmc(filp);
282 wait_event_interruptible(kcs_bmc->queue,
283 kcs_bmc->data_in_avail);
285 mutex_lock(&kcs_bmc->mutex);
287 spin_lock_irq(&kcs_bmc->lock);
288 data_avail = kcs_bmc->data_in_avail;
290 data_len = kcs_bmc->data_in_idx;
291 memcpy(kcs_bmc->kbuffer, kcs_bmc->data_in, data_len);
293 spin_unlock_irq(&kcs_bmc->lock);
302 kcs_bmc->channel, data_len);
304 spin_lock_irq(&kcs_bmc->lock);
305 kcs_force_abort(kcs_bmc);
306 spin_unlock_irq(&kcs_bmc->lock);
312 if (copy_to_user(buf, kcs_bmc->kbuffer, data_len)) {
319 spin_lock_irq(&kcs_bmc->lock);
320 if (kcs_bmc->phase == KCS_PHASE_WRITE_DONE) {
321 kcs_bmc->phase = KCS_PHASE_WAIT_READ;
322 kcs_bmc->data_in_avail = false;
323 kcs_bmc->data_in_idx = 0;
327 spin_unlock_irq(&kcs_bmc->lock);
330 mutex_unlock(&kcs_bmc->mutex);
338 struct kcs_bmc *kcs_bmc = to_kcs_bmc(filp);
345 mutex_lock(&kcs_bmc->mutex);
347 if (copy_from_user(kcs_bmc->kbuffer, buf, count)) {
352 spin_lock_irq(&kcs_bmc->lock);
353 if (kcs_bmc->phase == KCS_PHASE_WAIT_READ) {
354 kcs_bmc->phase = KCS_PHASE_READ;
355 kcs_bmc->data_out_idx = 1;
356 kcs_bmc->data_out_len = count;
357 memcpy(kcs_bmc->data_out, kcs_bmc->kbuffer, count);
358 write_data(kcs_bmc, kcs_bmc->data_out[0]);
363 spin_unlock_irq(&kcs_bmc->lock);
366 mutex_unlock(&kcs_bmc->mutex);
374 struct kcs_bmc *kcs_bmc = to_kcs_bmc(filp);
377 spin_lock_irq(&kcs_bmc->lock);
381 update_status_bits(kcs_bmc, KCS_STATUS_SMS_ATN,
386 update_status_bits(kcs_bmc, KCS_STATUS_SMS_ATN,
391 kcs_force_abort(kcs_bmc);
399 spin_unlock_irq(&kcs_bmc->lock);
406 struct kcs_bmc *kcs_bmc = to_kcs_bmc(filp);
408 spin_lock_irq(&kcs_bmc->lock);
409 kcs_bmc->running = 0;
410 kcs_force_abort(kcs_bmc);
411 spin_unlock_irq(&kcs_bmc->lock);
426 struct kcs_bmc *kcs_bmc_alloc(struct device *dev, int sizeof_priv, u32 channel)
428 struct kcs_bmc *kcs_bmc;
430 kcs_bmc = devm_kzalloc(dev, sizeof(*kcs_bmc) + sizeof_priv, GFP_KERNEL);
431 if (!kcs_bmc)
434 spin_lock_init(&kcs_bmc->lock);
435 kcs_bmc->channel = channel;
437 mutex_init(&kcs_bmc->mutex);
438 init_waitqueue_head(&kcs_bmc->queue);
440 kcs_bmc->data_in = devm_kmalloc(dev, KCS_MSG_BUFSIZ, GFP_KERNEL);
441 kcs_bmc->data_out = devm_kmalloc(dev, KCS_MSG_BUFSIZ, GFP_KERNEL);
442 kcs_bmc->kbuffer = devm_kmalloc(dev, KCS_MSG_BUFSIZ, GFP_KERNEL);
444 kcs_bmc->miscdev.minor = MISC_DYNAMIC_MINOR;
445 kcs_bmc->miscdev.name = devm_kasprintf(dev, GFP_KERNEL, "%s%u",
447 if (!kcs_bmc->data_in || !kcs_bmc->data_out || !kcs_bmc->kbuffer ||
448 !kcs_bmc->miscdev.name)
450 kcs_bmc->miscdev.fops = &kcs_bmc_fops;
452 return kcs_bmc;